1 /******************************************************************************
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.
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
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.
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.
22 * The full GNU General Public License is included in this distribution
23 * in the file called COPYING.
25 * Contact Information:
26 * Intel Linux Wireless <linuxwifi@intel.com>
27 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
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.
37 * Redistribution and use in source and binary forms, with or without
38 * modification, are permitted provided that the following conditions
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
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.
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.
63 *****************************************************************************/
64 #include "api/commands.h"
68 #define FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
69 struct dbgfs_##name##_data { \
75 static int _iwl_dbgfs_##name##_open(struct inode *inode, \
78 struct dbgfs_##name##_data *data; \
80 data = kzalloc(sizeof(*data), GFP_KERNEL); \
84 data->read_done = false; \
85 data->arg = inode->i_private; \
86 file->private_data = data; \
91 #define FWRT_DEBUGFS_READ_WRAPPER(name) \
92 static ssize_t _iwl_dbgfs_##name##_read(struct file *file, \
93 char __user *user_buf, \
94 size_t count, loff_t *ppos) \
96 struct dbgfs_##name##_data *data = file->private_data; \
98 if (!data->read_done) { \
99 data->read_done = true; \
100 data->rlen = iwl_dbgfs_##name##_read(data->arg, \
105 if (data->rlen < 0) \
107 return simple_read_from_buffer(user_buf, count, ppos, \
108 data->rbuf, data->rlen); \
111 static int _iwl_dbgfs_release(struct inode
*inode
, struct file
*file
)
113 kfree(file
->private_data
);
118 #define _FWRT_DEBUGFS_READ_FILE_OPS(name, buflen, argtype) \
119 FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
120 FWRT_DEBUGFS_READ_WRAPPER(name) \
121 static 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, \
128 #define FWRT_DEBUGFS_WRITE_WRAPPER(name, buflen, argtype) \
129 static ssize_t _iwl_dbgfs_##name##_write(struct file *file, \
130 const char __user *user_buf, \
131 size_t count, loff_t *ppos) \
134 ((struct dbgfs_##name##_data *)file->private_data)->arg;\
135 char buf[buflen] = {}; \
136 size_t buf_size = min(count, sizeof(buf) - 1); \
138 if (copy_from_user(buf, user_buf, buf_size)) \
141 return iwl_dbgfs_##name##_write(arg, buf, buf_size); \
144 #define _FWRT_DEBUGFS_READ_WRITE_FILE_OPS(name, buflen, argtype) \
145 FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
146 FWRT_DEBUGFS_WRITE_WRAPPER(name, buflen, argtype) \
147 FWRT_DEBUGFS_READ_WRAPPER(name) \
148 static 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, \
156 #define _FWRT_DEBUGFS_WRITE_FILE_OPS(name, buflen, argtype) \
157 FWRT_DEBUGFS_OPEN_WRAPPER(name, buflen, argtype) \
158 FWRT_DEBUGFS_WRITE_WRAPPER(name, buflen, argtype) \
159 static 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, \
166 #define FWRT_DEBUGFS_READ_FILE_OPS(name, bufsz) \
167 _FWRT_DEBUGFS_READ_FILE_OPS(name, bufsz, struct iwl_fw_runtime)
169 #define FWRT_DEBUGFS_WRITE_FILE_OPS(name, bufsz) \
170 _FWRT_DEBUGFS_WRITE_FILE_OPS(name, bufsz, struct iwl_fw_runtime)
172 #define FWRT_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz) \
173 _FWRT_DEBUGFS_READ_WRITE_FILE_OPS(name, bufsz, struct iwl_fw_runtime)
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); \
179 #define FWRT_DEBUGFS_ADD_FILE(name, parent, mode) \
180 FWRT_DEBUGFS_ADD_FILE_ALIAS(#name, name, parent, mode)
182 static int iwl_fw_send_timestamp_marker_cmd(struct iwl_fw_runtime
*fwrt
)
184 struct iwl_mvm_marker marker
= {
185 .dw_len
= sizeof(struct iwl_mvm_marker
) / 4,
186 .marker_id
= MARKER_ID_SYNC_CLOCK
,
188 /* the real timestamp is taken from the ftrace clock
189 * this is for finding the match between fw and kernel logs
191 .timestamp
= cpu_to_le64(fwrt
->timestamp
.seq
++),
194 struct iwl_host_cmd hcmd
= {
198 .len
[0] = sizeof(marker
),
201 return iwl_trans_send_cmd(fwrt
->trans
, &hcmd
);
204 static void iwl_fw_timestamp_marker_wk(struct work_struct
*work
)
207 struct iwl_fw_runtime
*fwrt
=
208 container_of(work
, struct iwl_fw_runtime
, timestamp
.wk
.work
);
209 unsigned long delay
= fwrt
->timestamp
.delay
;
211 ret
= iwl_fw_send_timestamp_marker_cmd(fwrt
);
213 schedule_delayed_work(&fwrt
->timestamp
.wk
,
214 round_jiffies_relative(delay
));
217 "stopping timestamp_marker, ret: %d, delay: %u\n",
218 ret
, jiffies_to_msecs(delay
) / 1000);
221 void iwl_fw_trigger_timestamp(struct iwl_fw_runtime
*fwrt
, u32 delay
)
224 "starting timestamp_marker trigger with delay: %us\n",
227 iwl_fw_cancel_timestamp(fwrt
);
229 fwrt
->timestamp
.delay
= msecs_to_jiffies(delay
* 1000);
231 schedule_delayed_work(&fwrt
->timestamp
.wk
,
232 round_jiffies_relative(fwrt
->timestamp
.delay
));
235 static ssize_t
iwl_dbgfs_timestamp_marker_write(struct iwl_fw_runtime
*fwrt
,
236 char *buf
, size_t count
)
241 ret
= kstrtou32(buf
, 10, &delay
);
245 iwl_fw_trigger_timestamp(fwrt
, delay
);
250 static ssize_t
iwl_dbgfs_timestamp_marker_read(struct iwl_fw_runtime
*fwrt
,
251 size_t size
, char *buf
)
253 u32 delay_secs
= jiffies_to_msecs(fwrt
->timestamp
.delay
) / 1000;
255 return scnprintf(buf
, size
, "%d\n", delay_secs
);
258 FWRT_DEBUGFS_READ_WRITE_FILE_OPS(timestamp_marker
, 16);
260 struct hcmd_write_data
{
267 static ssize_t
iwl_dbgfs_send_hcmd_write(struct iwl_fw_runtime
*fwrt
, char *buf
,
270 size_t header_size
= (sizeof(u32
) * 2 + sizeof(u16
)) * 2;
271 size_t data_size
= (count
- 1) / 2;
273 struct hcmd_write_data
*data
;
274 struct iwl_host_cmd hcmd
= {
279 if (fwrt
->ops
&& fwrt
->ops
->fw_running
&&
280 !fwrt
->ops
->fw_running(fwrt
->ops_ctx
))
283 if (count
< header_size
+ 1 || count
> 1024 * 4)
286 data
= kmalloc(data_size
, GFP_KERNEL
);
290 ret
= hex2bin((u8
*)data
, buf
, data_size
);
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
;
299 if (count
!= header_size
+ hcmd
.len
[0] * 2 + 1) {
301 "host command data size does not match header length\n");
306 if (fwrt
->ops
&& fwrt
->ops
->send_hcmd
)
307 ret
= fwrt
->ops
->send_hcmd(fwrt
->ops_ctx
, &hcmd
);
314 if (hcmd
.flags
& CMD_WANT_SKB
)
315 iwl_free_resp(&hcmd
);
321 FWRT_DEBUGFS_WRITE_FILE_OPS(send_hcmd
, 512);
323 void iwl_fwrt_dbgfs_register(struct iwl_fw_runtime
*fwrt
,
324 struct dentry
*dbgfs_dir
)
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);