Loading...
1// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2/*
3 * Copyright (C) 2012-2014, 2018-2023 Intel Corporation
4 * Copyright (C) 2013-2015 Intel Mobile Communications GmbH
5 * Copyright (C) 2016-2017 Intel Deutschland GmbH
6 */
7#include "api/commands.h"
8#include "debugfs.h"
9#include "dbg.h"
10#include <linux/seq_file.h>
11
12#define FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
13struct dbgfs_##name##_data { \
14 argtype *arg; \
15 bool read_done; \
16 ssize_t rlen; \
17 char rbuf[buflen]; \
18}; \
19static int _iwl_dbgfs_##name##_open(struct inode *inode, \
20 struct file *file) \
21{ \
22 struct dbgfs_##name##_data *data; \
23 \
24 data = kzalloc(sizeof(*data), GFP_KERNEL); \
25 if (!data) \
26 return -ENOMEM; \
27 \
28 data->read_done = false; \
29 data->arg = inode->i_private; \
30 file->private_data = data; \
31 \
32 return 0; \
33}
34
35#define FWRT_DEBUGFS_READ_WRAPPER(name) \
36static ssize_t _iwl_dbgfs_##name##_read(struct file *file, \
37 char __user *user_buf, \
38 size_t count, loff_t *ppos) \
39{ \
40 struct dbgfs_##name##_data *data = file->private_data; \
41 \
42 if (!data->read_done) { \
43 data->read_done = true; \
44 data->rlen = iwl_dbgfs_##name##_read(data->arg, \
45 sizeof(data->rbuf),\
46 data->rbuf); \
47 } \
48 \
49 if (data->rlen < 0) \
50 return data->rlen; \
51 return simple_read_from_buffer(user_buf, count, ppos, \
52 data->rbuf, data->rlen); \
53}
54
55static int _iwl_dbgfs_release(struct inode *inode, struct file *file)
56{
57 kfree(file->private_data);
58
59 return 0;
60}
61
62#define _FWRT_DEBUGFS_READ_FILE_OPS(name, buflen, argtype) \
63FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
64FWRT_DEBUGFS_READ_WRAPPER(name) \
65static const struct file_operations iwl_dbgfs_##name##_ops = { \
66 .read = _iwl_dbgfs_##name##_read, \
67 .open = _iwl_dbgfs_##name##_open, \
68 .llseek = generic_file_llseek, \
69 .release = _iwl_dbgfs_release, \
70}
71
72#define FWRT_DEBUGFS_WRITE_WRAPPER(name, buflen, argtype) \
73static ssize_t _iwl_dbgfs_##name##_write(struct file *file, \
74 const char __user *user_buf, \
75 size_t count, loff_t *ppos) \
76{ \
77 argtype *arg = \
78 ((struct dbgfs_##name##_data *)file->private_data)->arg;\
79 char buf[buflen] = {}; \
80 size_t buf_size = min(count, sizeof(buf) - 1); \
81 \
82 if (copy_from_user(buf, user_buf, buf_size)) \
83 return -EFAULT; \
84 \
85 return iwl_dbgfs_##name##_write(arg, buf, buf_size); \
86}
87
88#define _FWRT_DEBUGFS_READ_WRITE_FILE_OPS(name, buflen, argtype) \
89FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
90FWRT_DEBUGFS_WRITE_WRAPPER(name, buflen, argtype) \
91FWRT_DEBUGFS_READ_WRAPPER(name) \
92static const struct file_operations iwl_dbgfs_##name##_ops = { \
93 .write = _iwl_dbgfs_##name##_write, \
94 .read = _iwl_dbgfs_##name##_read, \
95 .open = _iwl_dbgfs_##name##_open, \
96 .llseek = generic_file_llseek, \
97 .release = _iwl_dbgfs_release, \
98}
99
100#define _FWRT_DEBUGFS_WRITE_FILE_OPS(name, buflen, argtype) \
101FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
102FWRT_DEBUGFS_WRITE_WRAPPER(name, buflen, argtype) \
103static const struct file_operations iwl_dbgfs_##name##_ops = { \
104 .write = _iwl_dbgfs_##name##_write, \
105 .open = _iwl_dbgfs_##name##_open, \
106 .llseek = generic_file_llseek, \
107 .release = _iwl_dbgfs_release, \
108}
109
110#define FWRT_DEBUGFS_READ_FILE_OPS(name, bufsz) \
111 _FWRT_DEBUGFS_READ_FILE_OPS(name, bufsz, struct iwl_fw_runtime)
112
113#define FWRT_DEBUGFS_WRITE_FILE_OPS(name, bufsz) \
114 _FWRT_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct iwl_fw_runtime)
115
116#define FWRT_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz) \
117 _FWRT_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct iwl_fw_runtime)
118
119#define FWRT_DEBUGFS_ADD_FILE_ALIAS(alias, name, parent, mode) do { \
120 debugfs_create_file(alias, mode, parent, fwrt, \
121 &iwl_dbgfs_##name##_ops); \
122 } while (0)
123#define FWRT_DEBUGFS_ADD_FILE(name, parent, mode) \
124 FWRT_DEBUGFS_ADD_FILE_ALIAS(#name, name, parent, mode)
125
126static int iwl_dbgfs_enabled_severities_write(struct iwl_fw_runtime *fwrt,
127 char *buf, size_t count)
128{
129 struct iwl_dbg_host_event_cfg_cmd event_cfg;
130 struct iwl_host_cmd hcmd = {
131 .id = WIDE_ID(DEBUG_GROUP, HOST_EVENT_CFG),
132 .flags = CMD_ASYNC,
133 .data[0] = &event_cfg,
134 .len[0] = sizeof(event_cfg),
135 };
136 u32 enabled_severities;
137 int ret = kstrtou32(buf, 10, &enabled_severities);
138
139 if (ret < 0)
140 return ret;
141
142 event_cfg.enabled_severities = cpu_to_le32(enabled_severities);
143
144 if (fwrt->ops && fwrt->ops->send_hcmd)
145 ret = fwrt->ops->send_hcmd(fwrt->ops_ctx, &hcmd);
146 else
147 ret = -EPERM;
148
149 IWL_INFO(fwrt,
150 "sent host event cfg with enabled_severities: %u, ret: %d\n",
151 enabled_severities, ret);
152
153 return ret ?: count;
154}
155
156FWRT_DEBUGFS_WRITE_FILE_OPS(enabled_severities, 16);
157
158static void iwl_fw_timestamp_marker_wk(struct work_struct *work)
159{
160 int ret;
161 struct iwl_fw_runtime *fwrt =
162 container_of(work, struct iwl_fw_runtime, timestamp.wk.work);
163 unsigned long delay = fwrt->timestamp.delay;
164
165 ret = iwl_fw_send_timestamp_marker_cmd(fwrt);
166 if (!ret && delay)
167 schedule_delayed_work(&fwrt->timestamp.wk,
168 round_jiffies_relative(delay));
169 else
170 IWL_INFO(fwrt,
171 "stopping timestamp_marker, ret: %d, delay: %u\n",
172 ret, jiffies_to_msecs(delay) / 1000);
173}
174
175void iwl_fw_trigger_timestamp(struct iwl_fw_runtime *fwrt, u32 delay)
176{
177 IWL_INFO(fwrt,
178 "starting timestamp_marker trigger with delay: %us\n",
179 delay);
180
181 iwl_fw_cancel_timestamp(fwrt);
182
183 fwrt->timestamp.delay = msecs_to_jiffies(delay * 1000);
184
185 schedule_delayed_work(&fwrt->timestamp.wk,
186 round_jiffies_relative(fwrt->timestamp.delay));
187}
188
189static ssize_t iwl_dbgfs_timestamp_marker_write(struct iwl_fw_runtime *fwrt,
190 char *buf, size_t count)
191{
192 int ret;
193 u32 delay;
194
195 ret = kstrtou32(buf, 10, &delay);
196 if (ret < 0)
197 return ret;
198
199 iwl_fw_trigger_timestamp(fwrt, delay);
200
201 return count;
202}
203
204static ssize_t iwl_dbgfs_timestamp_marker_read(struct iwl_fw_runtime *fwrt,
205 size_t size, char *buf)
206{
207 u32 delay_secs = jiffies_to_msecs(fwrt->timestamp.delay) / 1000;
208
209 return scnprintf(buf, size, "%d\n", delay_secs);
210}
211
212FWRT_DEBUGFS_READ_WRITE_FILE_OPS(timestamp_marker, 16);
213
214struct hcmd_write_data {
215 __be32 cmd_id;
216 __be32 flags;
217 __be16 length;
218 u8 data[];
219} __packed;
220
221static ssize_t iwl_dbgfs_send_hcmd_write(struct iwl_fw_runtime *fwrt, char *buf,
222 size_t count)
223{
224 size_t header_size = (sizeof(u32) * 2 + sizeof(u16)) * 2;
225 size_t data_size = (count - 1) / 2;
226 int ret;
227 struct hcmd_write_data *data;
228 struct iwl_host_cmd hcmd = {
229 .len = { 0, },
230 .data = { NULL, },
231 };
232
233 if (fwrt->ops && fwrt->ops->fw_running &&
234 !fwrt->ops->fw_running(fwrt->ops_ctx))
235 return -EIO;
236
237 if (count < header_size + 1 || count > 1024 * 4)
238 return -EINVAL;
239
240 data = kmalloc(data_size, GFP_KERNEL);
241 if (!data)
242 return -ENOMEM;
243
244 ret = hex2bin((u8 *)data, buf, data_size);
245 if (ret)
246 goto out;
247
248 hcmd.id = be32_to_cpu(data->cmd_id);
249 hcmd.flags = be32_to_cpu(data->flags);
250 hcmd.len[0] = be16_to_cpu(data->length);
251 hcmd.data[0] = data->data;
252
253 if (count != header_size + hcmd.len[0] * 2 + 1) {
254 IWL_ERR(fwrt,
255 "host command data size does not match header length\n");
256 ret = -EINVAL;
257 goto out;
258 }
259
260 if (fwrt->ops && fwrt->ops->send_hcmd)
261 ret = fwrt->ops->send_hcmd(fwrt->ops_ctx, &hcmd);
262 else
263 ret = -EPERM;
264
265 if (ret < 0)
266 goto out;
267
268 if (hcmd.flags & CMD_WANT_SKB)
269 iwl_free_resp(&hcmd);
270out:
271 kfree(data);
272 return ret ?: count;
273}
274
275FWRT_DEBUGFS_WRITE_FILE_OPS(send_hcmd, 512);
276
277static ssize_t iwl_dbgfs_fw_dbg_domain_read(struct iwl_fw_runtime *fwrt,
278 size_t size, char *buf)
279{
280 return scnprintf(buf, size, "0x%08x\n",
281 fwrt->trans->dbg.domains_bitmap);
282}
283
284FWRT_DEBUGFS_READ_FILE_OPS(fw_dbg_domain, 20);
285
286struct iwl_dbgfs_fw_info_priv {
287 struct iwl_fw_runtime *fwrt;
288};
289
290struct iwl_dbgfs_fw_info_state {
291 loff_t pos;
292};
293
294static void *iwl_dbgfs_fw_info_seq_next(struct seq_file *seq,
295 void *v, loff_t *pos)
296{
297 struct iwl_dbgfs_fw_info_state *state = v;
298 struct iwl_dbgfs_fw_info_priv *priv = seq->private;
299 const struct iwl_fw *fw = priv->fwrt->fw;
300
301 *pos = ++state->pos;
302 if (*pos >= fw->ucode_capa.n_cmd_versions) {
303 kfree(state);
304 return NULL;
305 }
306
307 return state;
308}
309
310static void iwl_dbgfs_fw_info_seq_stop(struct seq_file *seq,
311 void *v)
312{
313 kfree(v);
314}
315
316static void *iwl_dbgfs_fw_info_seq_start(struct seq_file *seq, loff_t *pos)
317{
318 struct iwl_dbgfs_fw_info_priv *priv = seq->private;
319 const struct iwl_fw *fw = priv->fwrt->fw;
320 struct iwl_dbgfs_fw_info_state *state;
321
322 if (*pos >= fw->ucode_capa.n_cmd_versions)
323 return NULL;
324
325 state = kzalloc(sizeof(*state), GFP_KERNEL);
326 if (!state)
327 return NULL;
328 state->pos = *pos;
329 return state;
330};
331
332static int iwl_dbgfs_fw_info_seq_show(struct seq_file *seq, void *v)
333{
334 struct iwl_dbgfs_fw_info_state *state = v;
335 struct iwl_dbgfs_fw_info_priv *priv = seq->private;
336 const struct iwl_fw *fw = priv->fwrt->fw;
337 const struct iwl_fw_cmd_version *ver;
338 u32 cmd_id;
339 int has_capa;
340
341 if (!state->pos) {
342 seq_puts(seq, "fw_capa:\n");
343 has_capa = fw_has_capa(&fw->ucode_capa,
344 IWL_UCODE_TLV_CAPA_PPAG_CHINA_BIOS_SUPPORT) ? 1 : 0;
345 seq_printf(seq,
346 " %d: %d\n",
347 IWL_UCODE_TLV_CAPA_PPAG_CHINA_BIOS_SUPPORT,
348 has_capa);
349 has_capa = fw_has_capa(&fw->ucode_capa,
350 IWL_UCODE_TLV_CAPA_CHINA_22_REG_SUPPORT) ? 1 : 0;
351 seq_printf(seq,
352 " %d: %d\n",
353 IWL_UCODE_TLV_CAPA_CHINA_22_REG_SUPPORT,
354 has_capa);
355 seq_puts(seq, "fw_api_ver:\n");
356 }
357
358 ver = &fw->ucode_capa.cmd_versions[state->pos];
359
360 cmd_id = WIDE_ID(ver->group, ver->cmd);
361
362 seq_printf(seq, " 0x%04x:\n", cmd_id);
363 seq_printf(seq, " name: %s\n",
364 iwl_get_cmd_string(priv->fwrt->trans, cmd_id));
365 seq_printf(seq, " cmd_ver: %d\n", ver->cmd_ver);
366 seq_printf(seq, " notif_ver: %d\n", ver->notif_ver);
367 return 0;
368}
369
370static const struct seq_operations iwl_dbgfs_info_seq_ops = {
371 .start = iwl_dbgfs_fw_info_seq_start,
372 .next = iwl_dbgfs_fw_info_seq_next,
373 .stop = iwl_dbgfs_fw_info_seq_stop,
374 .show = iwl_dbgfs_fw_info_seq_show,
375};
376
377static int iwl_dbgfs_fw_info_open(struct inode *inode, struct file *filp)
378{
379 struct iwl_dbgfs_fw_info_priv *priv;
380
381 priv = __seq_open_private(filp, &iwl_dbgfs_info_seq_ops,
382 sizeof(*priv));
383
384 if (!priv)
385 return -ENOMEM;
386
387 priv->fwrt = inode->i_private;
388 return 0;
389}
390
391static const struct file_operations iwl_dbgfs_fw_info_ops = {
392 .owner = THIS_MODULE,
393 .open = iwl_dbgfs_fw_info_open,
394 .read = seq_read,
395 .llseek = seq_lseek,
396 .release = seq_release_private,
397};
398
399void iwl_fwrt_dbgfs_register(struct iwl_fw_runtime *fwrt,
400 struct dentry *dbgfs_dir)
401{
402 INIT_DELAYED_WORK(&fwrt->timestamp.wk, iwl_fw_timestamp_marker_wk);
403 FWRT_DEBUGFS_ADD_FILE(timestamp_marker, dbgfs_dir, 0200);
404 FWRT_DEBUGFS_ADD_FILE(fw_info, dbgfs_dir, 0200);
405 FWRT_DEBUGFS_ADD_FILE(send_hcmd, dbgfs_dir, 0200);
406 FWRT_DEBUGFS_ADD_FILE(enabled_severities, dbgfs_dir, 0200);
407 FWRT_DEBUGFS_ADD_FILE(fw_dbg_domain, dbgfs_dir, 0400);
408}
1/******************************************************************************
2 *
3 * This file is provided under a dual BSD/GPLv2 license. When using or
4 * redistributing this file, you may do so under either license.
5 *
6 * GPL LICENSE SUMMARY
7 *
8 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
9 * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH
10 * Copyright(c) 2016 - 2017 Intel Deutschland GmbH
11 * Copyright (C) 2018 Intel Corporation
12 *
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of version 2 of the GNU General Public License as
15 * published by the Free Software Foundation.
16 *
17 * This program is distributed in the hope that it will be useful, but
18 * WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
20 * General Public License for more details.
21 *
22 * The full GNU General Public License is included in this distribution
23 * in the file called COPYING.
24 *
25 * Contact Information:
26 * Intel Linux Wireless <linuxwifi@intel.com>
27 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
28 *
29 * BSD LICENSE
30 *
31 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
32 * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH
33 * Copyright(c) 2016 - 2017 Intel Deutschland GmbH
34 * Copyright (C) 2018 Intel Corporation
35 * All rights reserved.
36 *
37 * Redistribution and use in source and binary forms, with or without
38 * modification, are permitted provided that the following conditions
39 * are met:
40 *
41 * * Redistributions of source code must retain the above copyright
42 * notice, this list of conditions and the following disclaimer.
43 * * Redistributions in binary form must reproduce the above copyright
44 * notice, this list of conditions and the following disclaimer in
45 * the documentation and/or other materials provided with the
46 * distribution.
47 * * Neither the name Intel Corporation nor the names of its
48 * contributors may be used to endorse or promote products derived
49 * from this software without specific prior written permission.
50 *
51 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
52 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
53 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
54 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
55 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
56 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
57 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
58 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
59 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
60 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
61 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
62 *
63 *****************************************************************************/
64#include "api/commands.h"
65#include "debugfs.h"
66#include "dbg.h"
67
68#define FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
69struct dbgfs_##name##_data { \
70 argtype *arg; \
71 bool read_done; \
72 ssize_t rlen; \
73 char rbuf[buflen]; \
74}; \
75static int _iwl_dbgfs_##name##_open(struct inode *inode, \
76 struct file *file) \
77{ \
78 struct dbgfs_##name##_data *data; \
79 \
80 data = kzalloc(sizeof(*data), GFP_KERNEL); \
81 if (!data) \
82 return -ENOMEM; \
83 \
84 data->read_done = false; \
85 data->arg = inode->i_private; \
86 file->private_data = data; \
87 \
88 return 0; \
89}
90
91#define FWRT_DEBUGFS_READ_WRAPPER(name) \
92static ssize_t _iwl_dbgfs_##name##_read(struct file *file, \
93 char __user *user_buf, \
94 size_t count, loff_t *ppos) \
95{ \
96 struct dbgfs_##name##_data *data = file->private_data; \
97 \
98 if (!data->read_done) { \
99 data->read_done = true; \
100 data->rlen = iwl_dbgfs_##name##_read(data->arg, \
101 sizeof(data->rbuf),\
102 data->rbuf); \
103 } \
104 \
105 if (data->rlen < 0) \
106 return data->rlen; \
107 return simple_read_from_buffer(user_buf, count, ppos, \
108 data->rbuf, data->rlen); \
109}
110
111static int _iwl_dbgfs_release(struct inode *inode, struct file *file)
112{
113 kfree(file->private_data);
114
115 return 0;
116}
117
118#define _FWRT_DEBUGFS_READ_FILE_OPS(name, buflen, argtype) \
119FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
120FWRT_DEBUGFS_READ_WRAPPER(name) \
121static const struct file_operations iwl_dbgfs_##name##_ops = { \
122 .read = _iwl_dbgfs_##name##_read, \
123 .open = _iwl_dbgfs_##name##_open, \
124 .llseek = generic_file_llseek, \
125 .release = _iwl_dbgfs_release, \
126}
127
128#define FWRT_DEBUGFS_WRITE_WRAPPER(name, buflen, argtype) \
129static ssize_t _iwl_dbgfs_##name##_write(struct file *file, \
130 const char __user *user_buf, \
131 size_t count, loff_t *ppos) \
132{ \
133 argtype *arg = \
134 ((struct dbgfs_##name##_data *)file->private_data)->arg;\
135 char buf[buflen] = {}; \
136 size_t buf_size = min(count, sizeof(buf) - 1); \
137 \
138 if (copy_from_user(buf, user_buf, buf_size)) \
139 return -EFAULT; \
140 \
141 return iwl_dbgfs_##name##_write(arg, buf, buf_size); \
142}
143
144#define _FWRT_DEBUGFS_READ_WRITE_FILE_OPS(name, buflen, argtype) \
145FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
146FWRT_DEBUGFS_WRITE_WRAPPER(name, buflen, argtype) \
147FWRT_DEBUGFS_READ_WRAPPER(name) \
148static const struct file_operations iwl_dbgfs_##name##_ops = { \
149 .write = _iwl_dbgfs_##name##_write, \
150 .read = _iwl_dbgfs_##name##_read, \
151 .open = _iwl_dbgfs_##name##_open, \
152 .llseek = generic_file_llseek, \
153 .release = _iwl_dbgfs_release, \
154}
155
156#define _FWRT_DEBUGFS_WRITE_FILE_OPS(name, buflen, argtype) \
157FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
158FWRT_DEBUGFS_WRITE_WRAPPER(name, buflen, argtype) \
159static const struct file_operations iwl_dbgfs_##name##_ops = { \
160 .write = _iwl_dbgfs_##name##_write, \
161 .open = _iwl_dbgfs_##name##_open, \
162 .llseek = generic_file_llseek, \
163 .release = _iwl_dbgfs_release, \
164}
165
166#define FWRT_DEBUGFS_READ_FILE_OPS(name, bufsz) \
167 _FWRT_DEBUGFS_READ_FILE_OPS(name, bufsz, struct iwl_fw_runtime)
168
169#define FWRT_DEBUGFS_WRITE_FILE_OPS(name, bufsz) \
170 _FWRT_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct iwl_fw_runtime)
171
172#define FWRT_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz) \
173 _FWRT_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct iwl_fw_runtime)
174
175#define FWRT_DEBUGFS_ADD_FILE_ALIAS(alias, name, parent, mode) do { \
176 debugfs_create_file(alias, mode, parent, fwrt, \
177 &iwl_dbgfs_##name##_ops); \
178 } while (0)
179#define FWRT_DEBUGFS_ADD_FILE(name, parent, mode) \
180 FWRT_DEBUGFS_ADD_FILE_ALIAS(#name, name, parent, mode)
181
182static int iwl_fw_send_timestamp_marker_cmd(struct iwl_fw_runtime *fwrt)
183{
184 struct iwl_mvm_marker marker = {
185 .dw_len = sizeof(struct iwl_mvm_marker) / 4,
186 .marker_id = MARKER_ID_SYNC_CLOCK,
187
188 /* the real timestamp is taken from the ftrace clock
189 * this is for finding the match between fw and kernel logs
190 */
191 .timestamp = cpu_to_le64(fwrt->timestamp.seq++),
192 };
193
194 struct iwl_host_cmd hcmd = {
195 .id = MARKER_CMD,
196 .flags = CMD_ASYNC,
197 .data[0] = &marker,
198 .len[0] = sizeof(marker),
199 };
200
201 return iwl_trans_send_cmd(fwrt->trans, &hcmd);
202}
203
204static void iwl_fw_timestamp_marker_wk(struct work_struct *work)
205{
206 int ret;
207 struct iwl_fw_runtime *fwrt =
208 container_of(work, struct iwl_fw_runtime, timestamp.wk.work);
209 unsigned long delay = fwrt->timestamp.delay;
210
211 ret = iwl_fw_send_timestamp_marker_cmd(fwrt);
212 if (!ret && delay)
213 schedule_delayed_work(&fwrt->timestamp.wk,
214 round_jiffies_relative(delay));
215 else
216 IWL_INFO(fwrt,
217 "stopping timestamp_marker, ret: %d, delay: %u\n",
218 ret, jiffies_to_msecs(delay) / 1000);
219}
220
221void iwl_fw_trigger_timestamp(struct iwl_fw_runtime *fwrt, u32 delay)
222{
223 IWL_INFO(fwrt,
224 "starting timestamp_marker trigger with delay: %us\n",
225 delay);
226
227 iwl_fw_cancel_timestamp(fwrt);
228
229 fwrt->timestamp.delay = msecs_to_jiffies(delay * 1000);
230
231 schedule_delayed_work(&fwrt->timestamp.wk,
232 round_jiffies_relative(fwrt->timestamp.delay));
233}
234
235static ssize_t iwl_dbgfs_timestamp_marker_write(struct iwl_fw_runtime *fwrt,
236 char *buf, size_t count)
237{
238 int ret;
239 u32 delay;
240
241 ret = kstrtou32(buf, 10, &delay);
242 if (ret < 0)
243 return ret;
244
245 iwl_fw_trigger_timestamp(fwrt, delay);
246
247 return count;
248}
249
250static ssize_t iwl_dbgfs_timestamp_marker_read(struct iwl_fw_runtime *fwrt,
251 size_t size, char *buf)
252{
253 u32 delay_secs = jiffies_to_msecs(fwrt->timestamp.delay) / 1000;
254
255 return scnprintf(buf, size, "%d\n", delay_secs);
256}
257
258FWRT_DEBUGFS_READ_WRITE_FILE_OPS(timestamp_marker, 16);
259
260struct hcmd_write_data {
261 __be32 cmd_id;
262 __be32 flags;
263 __be16 length;
264 u8 data[0];
265} __packed;
266
267static ssize_t iwl_dbgfs_send_hcmd_write(struct iwl_fw_runtime *fwrt, char *buf,
268 size_t count)
269{
270 size_t header_size = (sizeof(u32) * 2 + sizeof(u16)) * 2;
271 size_t data_size = (count - 1) / 2;
272 int ret;
273 struct hcmd_write_data *data;
274 struct iwl_host_cmd hcmd = {
275 .len = { 0, },
276 .data = { NULL, },
277 };
278
279 if (fwrt->ops && fwrt->ops->fw_running &&
280 !fwrt->ops->fw_running(fwrt->ops_ctx))
281 return -EIO;
282
283 if (count < header_size + 1 || count > 1024 * 4)
284 return -EINVAL;
285
286 data = kmalloc(data_size, GFP_KERNEL);
287 if (!data)
288 return -ENOMEM;
289
290 ret = hex2bin((u8 *)data, buf, data_size);
291 if (ret)
292 goto out;
293
294 hcmd.id = be32_to_cpu(data->cmd_id);
295 hcmd.flags = be32_to_cpu(data->flags);
296 hcmd.len[0] = be16_to_cpu(data->length);
297 hcmd.data[0] = data->data;
298
299 if (count != header_size + hcmd.len[0] * 2 + 1) {
300 IWL_ERR(fwrt,
301 "host command data size does not match header length\n");
302 ret = -EINVAL;
303 goto out;
304 }
305
306 if (fwrt->ops && fwrt->ops->send_hcmd)
307 ret = fwrt->ops->send_hcmd(fwrt->ops_ctx, &hcmd);
308 else
309 ret = -EPERM;
310
311 if (ret < 0)
312 goto out;
313
314 if (hcmd.flags & CMD_WANT_SKB)
315 iwl_free_resp(&hcmd);
316out:
317 kfree(data);
318 return ret ?: count;
319}
320
321FWRT_DEBUGFS_WRITE_FILE_OPS(send_hcmd, 512);
322
323void iwl_fwrt_dbgfs_register(struct iwl_fw_runtime *fwrt,
324 struct dentry *dbgfs_dir)
325{
326 INIT_DELAYED_WORK(&fwrt->timestamp.wk, iwl_fw_timestamp_marker_wk);
327 FWRT_DEBUGFS_ADD_FILE(timestamp_marker, dbgfs_dir, 0200);
328 FWRT_DEBUGFS_ADD_FILE(send_hcmd, dbgfs_dir, 0200);
329}