diff options
Diffstat (limited to 'drivers/net/wireless/iwlwifi/iwl-debugfs.c')
-rw-r--r-- | drivers/net/wireless/iwlwifi/iwl-debugfs.c | 319 |
1 files changed, 319 insertions, 0 deletions
diff --git a/drivers/net/wireless/iwlwifi/iwl-debugfs.c b/drivers/net/wireless/iwlwifi/iwl-debugfs.c new file mode 100644 index 000000000000..c659bd3bc346 --- /dev/null +++ b/drivers/net/wireless/iwlwifi/iwl-debugfs.c | |||
@@ -0,0 +1,319 @@ | |||
1 | /****************************************************************************** | ||
2 | * | ||
3 | * GPL LICENSE SUMMARY | ||
4 | * | ||
5 | * Copyright(c) 2008 Intel Corporation. All rights reserved. | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or modify | ||
8 | * it under the terms of version 2 of the GNU General Public License as | ||
9 | * published by the Free Software Foundation. | ||
10 | * | ||
11 | * This program is distributed in the hope that it will be useful, but | ||
12 | * WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
14 | * General Public License for more details. | ||
15 | * | ||
16 | * You should have received a copy of the GNU General Public License | ||
17 | * along with this program; if not, write to the Free Software | ||
18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, | ||
19 | * USA | ||
20 | * | ||
21 | * The full GNU General Public License is included in this distribution | ||
22 | * in the file called LICENSE.GPL. | ||
23 | * | ||
24 | * Contact Information: | ||
25 | * Tomas Winkler <tomas.winkler@intel.com> | ||
26 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 | ||
27 | *****************************************************************************/ | ||
28 | |||
29 | #include <linux/kernel.h> | ||
30 | #include <linux/module.h> | ||
31 | #include <linux/debugfs.h> | ||
32 | |||
33 | #include <linux/ieee80211.h> | ||
34 | #include <net/mac80211.h> | ||
35 | |||
36 | |||
37 | #include "iwl-4965.h" | ||
38 | #include "iwl-debug.h" | ||
39 | #include "iwl-4965-io.h" | ||
40 | |||
41 | |||
42 | /* create and remove of files */ | ||
43 | #define DEBUGFS_ADD_DIR(name, parent) do { \ | ||
44 | dbgfs->dir_##name = debugfs_create_dir(#name, parent); \ | ||
45 | if (!(dbgfs->dir_##name)) \ | ||
46 | goto err; \ | ||
47 | } while (0) | ||
48 | |||
49 | #define DEBUGFS_ADD_FILE(name, parent) do { \ | ||
50 | dbgfs->dbgfs_##parent##_files.file_##name = \ | ||
51 | debugfs_create_file(#name, 0644, dbgfs->dir_##parent, priv, \ | ||
52 | &iwl_dbgfs_##name##_ops); \ | ||
53 | if (!(dbgfs->dbgfs_##parent##_files.file_##name)) \ | ||
54 | goto err; \ | ||
55 | } while (0) | ||
56 | |||
57 | #define DEBUGFS_REMOVE(name) do { \ | ||
58 | debugfs_remove(name); \ | ||
59 | name = NULL; \ | ||
60 | } while (0); | ||
61 | |||
62 | /* file operation */ | ||
63 | #define DEBUGFS_READ_FUNC(name) \ | ||
64 | static ssize_t iwl_dbgfs_##name##_read(struct file *file, \ | ||
65 | char __user *user_buf, \ | ||
66 | size_t count, loff_t *ppos); | ||
67 | |||
68 | #define DEBUGFS_WRITE_FUNC(name) \ | ||
69 | static ssize_t iwl_dbgfs_##name##_write(struct file *file, \ | ||
70 | const char __user *user_buf, \ | ||
71 | size_t count, loff_t *ppos); | ||
72 | |||
73 | |||
74 | static int iwl_dbgfs_open_file_generic(struct inode *inode, struct file *file) | ||
75 | { | ||
76 | file->private_data = inode->i_private; | ||
77 | return 0; | ||
78 | } | ||
79 | |||
80 | #define DEBUGFS_READ_FILE_OPS(name) \ | ||
81 | DEBUGFS_READ_FUNC(name); \ | ||
82 | static const struct file_operations iwl_dbgfs_##name##_ops = { \ | ||
83 | .read = iwl_dbgfs_##name##_read, \ | ||
84 | .open = iwl_dbgfs_open_file_generic, \ | ||
85 | }; | ||
86 | |||
87 | #define DEBUGFS_READ_WRITE_FILE_OPS(name) \ | ||
88 | DEBUGFS_READ_FUNC(name); \ | ||
89 | DEBUGFS_WRITE_FUNC(name); \ | ||
90 | static const struct file_operations iwl_dbgfs_##name##_ops = { \ | ||
91 | .write = iwl_dbgfs_##name##_write, \ | ||
92 | .read = iwl_dbgfs_##name##_read, \ | ||
93 | .open = iwl_dbgfs_open_file_generic, \ | ||
94 | }; | ||
95 | |||
96 | |||
97 | static ssize_t iwl_dbgfs_tx_statistics_read(struct file *file, | ||
98 | char __user *user_buf, | ||
99 | size_t count, loff_t *ppos) { | ||
100 | |||
101 | struct iwl_priv *priv = (struct iwl_priv *)file->private_data; | ||
102 | char buf[256]; | ||
103 | int pos = 0; | ||
104 | |||
105 | pos += sprintf(buf+pos, "mgmt: %u\n", priv->tx_stats[0].cnt); | ||
106 | pos += sprintf(buf+pos, "ctrl: %u\n", priv->tx_stats[1].cnt); | ||
107 | pos += sprintf(buf+pos, "data: %u\n", priv->tx_stats[2].cnt); | ||
108 | |||
109 | return simple_read_from_buffer(user_buf, count, ppos, buf, pos); | ||
110 | } | ||
111 | |||
112 | static ssize_t iwl_dbgfs_rx_statistics_read(struct file *file, | ||
113 | char __user *user_buf, | ||
114 | size_t count, loff_t *ppos) { | ||
115 | |||
116 | struct iwl_priv *priv = (struct iwl_priv *)file->private_data; | ||
117 | char buf[256]; | ||
118 | int pos = 0; | ||
119 | |||
120 | pos += sprintf(buf+pos, "mgmt: %u\n", priv->rx_stats[0].cnt); | ||
121 | pos += sprintf(buf+pos, "ctrl: %u\n", priv->rx_stats[1].cnt); | ||
122 | pos += sprintf(buf+pos, "data: %u\n", priv->rx_stats[2].cnt); | ||
123 | |||
124 | return simple_read_from_buffer(user_buf, count, ppos, buf, pos); | ||
125 | } | ||
126 | |||
127 | #define BYTE1_MASK 0x000000ff; | ||
128 | #define BYTE2_MASK 0x0000ffff; | ||
129 | #define BYTE3_MASK 0x00ffffff; | ||
130 | static ssize_t iwl_dbgfs_sram_read(struct file *file, | ||
131 | char __user *user_buf, | ||
132 | size_t count, loff_t *ppos) | ||
133 | { | ||
134 | u32 val; | ||
135 | char buf[1024]; | ||
136 | ssize_t ret; | ||
137 | int i; | ||
138 | int pos = 0; | ||
139 | struct iwl_priv *priv = (struct iwl_priv *)file->private_data; | ||
140 | |||
141 | printk(KERN_DEBUG "offset is: 0x%x\tlen is: 0x%x\n", | ||
142 | priv->dbgfs->sram_offset, priv->dbgfs->sram_len); | ||
143 | |||
144 | iwl4965_grab_nic_access(priv); | ||
145 | for (i = priv->dbgfs->sram_len; i > 0; i -= 4) { | ||
146 | val = iwl4965_read_targ_mem(priv, priv->dbgfs->sram_offset + \ | ||
147 | priv->dbgfs->sram_len - i); | ||
148 | if (i < 4) { | ||
149 | switch (i) { | ||
150 | case 1: | ||
151 | val &= BYTE1_MASK; | ||
152 | break; | ||
153 | case 2: | ||
154 | val &= BYTE2_MASK; | ||
155 | break; | ||
156 | case 3: | ||
157 | val &= BYTE3_MASK; | ||
158 | break; | ||
159 | } | ||
160 | } | ||
161 | pos += sprintf(buf+pos, "0x%08x ", val); | ||
162 | } | ||
163 | pos += sprintf(buf+pos, "\n"); | ||
164 | iwl4965_release_nic_access(priv); | ||
165 | |||
166 | ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); | ||
167 | return ret; | ||
168 | } | ||
169 | |||
170 | static ssize_t iwl_dbgfs_sram_write(struct file *file, | ||
171 | const char __user *user_buf, | ||
172 | size_t count, loff_t *ppos) | ||
173 | { | ||
174 | struct iwl_priv *priv = file->private_data; | ||
175 | char buf[64]; | ||
176 | int buf_size; | ||
177 | u32 offset, len; | ||
178 | |||
179 | memset(buf, 0, sizeof(buf)); | ||
180 | buf_size = min(count, sizeof(buf) - 1); | ||
181 | if (copy_from_user(buf, user_buf, buf_size)) | ||
182 | return -EFAULT; | ||
183 | |||
184 | if (sscanf(buf, "%x,%x", &offset, &len) == 2) { | ||
185 | priv->dbgfs->sram_offset = offset; | ||
186 | priv->dbgfs->sram_len = len; | ||
187 | } else { | ||
188 | priv->dbgfs->sram_offset = 0; | ||
189 | priv->dbgfs->sram_len = 0; | ||
190 | } | ||
191 | |||
192 | return count; | ||
193 | } | ||
194 | |||
195 | static ssize_t iwl_dbgfs_stations_read(struct file *file, char __user *user_buf, | ||
196 | size_t count, loff_t *ppos) | ||
197 | { | ||
198 | struct iwl_priv *priv = (struct iwl_priv *)file->private_data; | ||
199 | struct iwl4965_station_entry *station; | ||
200 | int max_sta = priv->hw_setting.max_stations; | ||
201 | char *buf; | ||
202 | int i, j, pos = 0; | ||
203 | ssize_t ret; | ||
204 | /* Add 30 for initial string */ | ||
205 | const size_t bufsz = 30 + sizeof(char) * 500 * (priv->num_stations); | ||
206 | DECLARE_MAC_BUF(mac); | ||
207 | |||
208 | buf = kmalloc(bufsz, GFP_KERNEL); | ||
209 | if(!buf) | ||
210 | return -ENOMEM; | ||
211 | |||
212 | pos += sprintf(buf+pos, "num of stations: %d\n\n", | ||
213 | priv->num_stations); | ||
214 | |||
215 | for (i = 0; i < max_sta; i++) { | ||
216 | station = &priv->stations[i]; | ||
217 | if (station->used) { | ||
218 | pos += sprintf(buf+pos, "station %d:\ngeneral data:\n", | ||
219 | i+1); | ||
220 | print_mac(mac, station->sta.sta.addr); | ||
221 | pos += sprintf(buf+pos, "id: %u\n", | ||
222 | station->sta.sta.sta_id); | ||
223 | pos += sprintf(buf+pos, "mode: %u\n", | ||
224 | station->sta.mode); | ||
225 | pos += sprintf(buf+pos, "flags: 0x%x\n", | ||
226 | station->sta.station_flags_msk); | ||
227 | pos += sprintf(buf+pos, "ps_status: %u\n", | ||
228 | station->ps_status); | ||
229 | |||
230 | pos += sprintf(buf+pos, "tid data:\n"); | ||
231 | |||
232 | pos += sprintf(buf+pos, "seq_num\t\ttxq_id\t"); | ||
233 | pos += sprintf(buf+pos, "frame_count\twait_for_ba\t"); | ||
234 | pos += sprintf(buf+pos, "start_idx\tbitmap0\t"); | ||
235 | pos += sprintf(buf+pos, "bitmap1\trate_n_flags\n"); | ||
236 | |||
237 | for (j = 0; j < MAX_TID_COUNT; j++) { | ||
238 | pos += sprintf(buf+pos, "[%d]:\t\t%u\t", | ||
239 | j, station->tid[j].seq_number); | ||
240 | pos += sprintf(buf+pos, "%u\t\t%u\t\t%u\t\t", | ||
241 | station->tid[j].agg.txq_id, | ||
242 | station->tid[j].agg.frame_count, | ||
243 | station->tid[j].agg.wait_for_ba); | ||
244 | pos += sprintf(buf+pos, "%u\t%llu\t%u\n", | ||
245 | station->tid[j].agg.start_idx, | ||
246 | station->tid[j].agg.bitmap, | ||
247 | station->tid[j].agg.rate_n_flags); | ||
248 | } | ||
249 | pos += sprintf(buf+pos, "\n"); | ||
250 | } | ||
251 | } | ||
252 | |||
253 | ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); | ||
254 | kfree(buf); | ||
255 | return ret; | ||
256 | } | ||
257 | |||
258 | |||
259 | DEBUGFS_READ_WRITE_FILE_OPS(sram); | ||
260 | DEBUGFS_READ_FILE_OPS(stations); | ||
261 | DEBUGFS_READ_FILE_OPS(rx_statistics); | ||
262 | DEBUGFS_READ_FILE_OPS(tx_statistics); | ||
263 | |||
264 | /* | ||
265 | * Create the debugfs files and directories | ||
266 | * | ||
267 | */ | ||
268 | int iwl_dbgfs_register(struct iwl_priv *priv, const char *name) | ||
269 | { | ||
270 | struct iwl_debugfs *dbgfs; | ||
271 | |||
272 | dbgfs = kzalloc(sizeof(struct iwl_debugfs), GFP_KERNEL); | ||
273 | if (!dbgfs) { | ||
274 | goto err; | ||
275 | } | ||
276 | |||
277 | priv->dbgfs = dbgfs; | ||
278 | dbgfs->name = name; | ||
279 | dbgfs->dir_drv = debugfs_create_dir(name, NULL); | ||
280 | if (!dbgfs->dir_drv || IS_ERR(dbgfs->dir_drv)){ | ||
281 | goto err; | ||
282 | } | ||
283 | |||
284 | DEBUGFS_ADD_DIR(data, dbgfs->dir_drv); | ||
285 | DEBUGFS_ADD_FILE(sram, data); | ||
286 | DEBUGFS_ADD_FILE(stations, data); | ||
287 | DEBUGFS_ADD_FILE(rx_statistics, data); | ||
288 | DEBUGFS_ADD_FILE(tx_statistics, data); | ||
289 | |||
290 | return 0; | ||
291 | |||
292 | err: | ||
293 | IWL_ERROR("Can't open the debugfs directory\n"); | ||
294 | iwl_dbgfs_unregister(priv); | ||
295 | return -ENOENT; | ||
296 | } | ||
297 | EXPORT_SYMBOL(iwl_dbgfs_register); | ||
298 | |||
299 | /** | ||
300 | * Remove the debugfs files and directories | ||
301 | * | ||
302 | */ | ||
303 | void iwl_dbgfs_unregister(struct iwl_priv *priv) | ||
304 | { | ||
305 | if (!(priv->dbgfs)) | ||
306 | return; | ||
307 | |||
308 | DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_rx_statistics); | ||
309 | DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_tx_statistics); | ||
310 | DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_sram); | ||
311 | DEBUGFS_REMOVE(priv->dbgfs->dbgfs_data_files.file_stations); | ||
312 | DEBUGFS_REMOVE(priv->dbgfs->dir_data); | ||
313 | DEBUGFS_REMOVE(priv->dbgfs->dir_drv); | ||
314 | kfree(priv->dbgfs); | ||
315 | priv->dbgfs = NULL; | ||
316 | } | ||
317 | EXPORT_SYMBOL(iwl_dbgfs_unregister); | ||
318 | |||
319 | |||