Commit | Line | Data |
---|---|---|
712b6cf5 TW |
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" | |
3395f6e9 | 39 | #include "iwl-io.h" |
712b6cf5 TW |
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 | ||
3395f6e9 | 144 | iwl_grab_nic_access(priv); |
712b6cf5 | 145 | for (i = priv->dbgfs->sram_len; i > 0; i -= 4) { |
3395f6e9 | 146 | val = iwl_read_targ_mem(priv, priv->dbgfs->sram_offset + \ |
712b6cf5 TW |
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"); | |
3395f6e9 | 164 | iwl_release_nic_access(priv); |
712b6cf5 TW |
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 |