Commit | Line | Data |
---|---|---|
876c9d3a MT |
1 | #include <linux/dcache.h> |
2 | #include <linux/debugfs.h> | |
3 | #include <linux/delay.h> | |
4 | #include <linux/mm.h> | |
d8b0fb51 | 5 | #include <linux/string.h> |
5a0e3ad6 | 6 | #include <linux/slab.h> |
46868202 | 7 | |
876c9d3a | 8 | #include "decl.h" |
3fbe104c | 9 | #include "cmd.h" |
e86dc1ca | 10 | #include "debugfs.h" |
876c9d3a | 11 | |
10078321 | 12 | static struct dentry *lbs_dir; |
876c9d3a MT |
13 | static char *szStates[] = { |
14 | "Connected", | |
15 | "Disconnected" | |
16 | }; | |
17 | ||
46868202 | 18 | #ifdef PROC_DEBUG |
e98a88dd | 19 | static void lbs_debug_init(struct lbs_private *priv); |
46868202 | 20 | #endif |
876c9d3a MT |
21 | |
22 | static int open_file_generic(struct inode *inode, struct file *file) | |
23 | { | |
24 | file->private_data = inode->i_private; | |
25 | return 0; | |
26 | } | |
27 | ||
28 | static ssize_t write_file_dummy(struct file *file, const char __user *buf, | |
29 | size_t count, loff_t *ppos) | |
30 | { | |
31 | return -EINVAL; | |
32 | } | |
33 | ||
34 | static const size_t len = PAGE_SIZE; | |
35 | ||
10078321 | 36 | static ssize_t lbs_dev_info(struct file *file, char __user *userbuf, |
876c9d3a MT |
37 | size_t count, loff_t *ppos) |
38 | { | |
69f9032d | 39 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
40 | size_t pos = 0; |
41 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
42 | char *buf = (char *)addr; | |
43 | ssize_t res; | |
ad43f8bf KD |
44 | if (!buf) |
45 | return -ENOMEM; | |
876c9d3a MT |
46 | |
47 | pos += snprintf(buf+pos, len-pos, "state = %s\n", | |
aa21c004 | 48 | szStates[priv->connect_status]); |
876c9d3a | 49 | pos += snprintf(buf+pos, len-pos, "region_code = %02x\n", |
aa21c004 | 50 | (u32) priv->regioncode); |
876c9d3a MT |
51 | |
52 | res = simple_read_from_buffer(userbuf, count, ppos, buf, pos); | |
53 | ||
54 | free_page(addr); | |
55 | return res; | |
56 | } | |
57 | ||
10078321 | 58 | static ssize_t lbs_sleepparams_write(struct file *file, |
876c9d3a MT |
59 | const char __user *user_buf, size_t count, |
60 | loff_t *ppos) | |
61 | { | |
69f9032d | 62 | struct lbs_private *priv = file->private_data; |
3fbe104c DW |
63 | ssize_t buf_size, ret; |
64 | struct sleep_params sp; | |
876c9d3a | 65 | int p1, p2, p3, p4, p5, p6; |
876c9d3a MT |
66 | unsigned long addr = get_zeroed_page(GFP_KERNEL); |
67 | char *buf = (char *)addr; | |
ad43f8bf KD |
68 | if (!buf) |
69 | return -ENOMEM; | |
876c9d3a MT |
70 | |
71 | buf_size = min(count, len - 1); | |
72 | if (copy_from_user(buf, user_buf, buf_size)) { | |
3fbe104c | 73 | ret = -EFAULT; |
876c9d3a MT |
74 | goto out_unlock; |
75 | } | |
3fbe104c DW |
76 | ret = sscanf(buf, "%d %d %d %d %d %d", &p1, &p2, &p3, &p4, &p5, &p6); |
77 | if (ret != 6) { | |
78 | ret = -EINVAL; | |
876c9d3a MT |
79 | goto out_unlock; |
80 | } | |
3fbe104c DW |
81 | sp.sp_error = p1; |
82 | sp.sp_offset = p2; | |
83 | sp.sp_stabletime = p3; | |
84 | sp.sp_calcontrol = p4; | |
85 | sp.sp_extsleepclk = p5; | |
86 | sp.sp_reserved = p6; | |
87 | ||
88 | ret = lbs_cmd_802_11_sleep_params(priv, CMD_ACT_SET, &sp); | |
89 | if (!ret) | |
90 | ret = count; | |
91 | else if (ret > 0) | |
92 | ret = -EINVAL; | |
876c9d3a MT |
93 | |
94 | out_unlock: | |
95 | free_page(addr); | |
3fbe104c | 96 | return ret; |
876c9d3a MT |
97 | } |
98 | ||
10078321 | 99 | static ssize_t lbs_sleepparams_read(struct file *file, char __user *userbuf, |
876c9d3a MT |
100 | size_t count, loff_t *ppos) |
101 | { | |
69f9032d | 102 | struct lbs_private *priv = file->private_data; |
3fbe104c | 103 | ssize_t ret; |
876c9d3a | 104 | size_t pos = 0; |
3fbe104c | 105 | struct sleep_params sp; |
876c9d3a MT |
106 | unsigned long addr = get_zeroed_page(GFP_KERNEL); |
107 | char *buf = (char *)addr; | |
ad43f8bf KD |
108 | if (!buf) |
109 | return -ENOMEM; | |
876c9d3a | 110 | |
3fbe104c DW |
111 | ret = lbs_cmd_802_11_sleep_params(priv, CMD_ACT_GET, &sp); |
112 | if (ret) | |
876c9d3a | 113 | goto out_unlock; |
876c9d3a | 114 | |
3fbe104c DW |
115 | pos += snprintf(buf, len, "%d %d %d %d %d %d\n", sp.sp_error, |
116 | sp.sp_offset, sp.sp_stabletime, | |
117 | sp.sp_calcontrol, sp.sp_extsleepclk, | |
118 | sp.sp_reserved); | |
876c9d3a | 119 | |
3fbe104c | 120 | ret = simple_read_from_buffer(userbuf, count, ppos, buf, pos); |
876c9d3a MT |
121 | |
122 | out_unlock: | |
123 | free_page(addr); | |
3fbe104c | 124 | return ret; |
876c9d3a MT |
125 | } |
126 | ||
1311843c AK |
127 | static ssize_t lbs_host_sleep_write(struct file *file, |
128 | const char __user *user_buf, size_t count, | |
129 | loff_t *ppos) | |
130 | { | |
131 | struct lbs_private *priv = file->private_data; | |
132 | ssize_t buf_size, ret; | |
133 | int host_sleep; | |
134 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
135 | char *buf = (char *)addr; | |
136 | if (!buf) | |
137 | return -ENOMEM; | |
138 | ||
139 | buf_size = min(count, len - 1); | |
140 | if (copy_from_user(buf, user_buf, buf_size)) { | |
141 | ret = -EFAULT; | |
142 | goto out_unlock; | |
143 | } | |
144 | ret = sscanf(buf, "%d", &host_sleep); | |
145 | if (ret != 1) { | |
146 | ret = -EINVAL; | |
147 | goto out_unlock; | |
148 | } | |
149 | ||
150 | if (host_sleep == 0) | |
151 | ret = lbs_set_host_sleep(priv, 0); | |
152 | else if (host_sleep == 1) { | |
153 | if (priv->wol_criteria == EHS_REMOVE_WAKEUP) { | |
154 | lbs_pr_info("wake parameters not configured"); | |
155 | ret = -EINVAL; | |
156 | goto out_unlock; | |
157 | } | |
158 | ret = lbs_set_host_sleep(priv, 1); | |
159 | } else { | |
160 | lbs_pr_err("invalid option\n"); | |
161 | ret = -EINVAL; | |
162 | } | |
163 | ||
164 | if (!ret) | |
165 | ret = count; | |
166 | ||
167 | out_unlock: | |
168 | free_page(addr); | |
169 | return ret; | |
170 | } | |
171 | ||
172 | static ssize_t lbs_host_sleep_read(struct file *file, char __user *userbuf, | |
173 | size_t count, loff_t *ppos) | |
174 | { | |
175 | struct lbs_private *priv = file->private_data; | |
176 | ssize_t ret; | |
177 | size_t pos = 0; | |
178 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
179 | char *buf = (char *)addr; | |
180 | if (!buf) | |
181 | return -ENOMEM; | |
182 | ||
183 | pos += snprintf(buf, len, "%d\n", priv->is_host_sleep_activated); | |
184 | ||
185 | ret = simple_read_from_buffer(userbuf, count, ppos, buf, pos); | |
186 | ||
187 | free_page(addr); | |
188 | return ret; | |
189 | } | |
190 | ||
3a188649 HS |
191 | /* |
192 | * When calling CMD_802_11_SUBSCRIBE_EVENT with CMD_ACT_GET, me might | |
193 | * get a bunch of vendor-specific TLVs (a.k.a. IEs) back from the | |
194 | * firmware. Here's an example: | |
195 | * 04 01 02 00 00 00 05 01 02 00 00 00 06 01 02 00 | |
196 | * 00 00 07 01 02 00 3c 00 00 00 00 00 00 00 03 03 | |
197 | * 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 | |
198 | * | |
199 | * The 04 01 is the TLV type (here TLV_TYPE_RSSI_LOW), 02 00 is the length, | |
200 | * 00 00 are the data bytes of this TLV. For this TLV, their meaning is | |
201 | * defined in mrvlietypes_thresholds | |
202 | * | |
203 | * This function searches in this TLV data chunk for a given TLV type | |
204 | * and returns a pointer to the first data byte of the TLV, or to NULL | |
205 | * if the TLV hasn't been found. | |
206 | */ | |
5844d12e | 207 | static void *lbs_tlv_find(uint16_t tlv_type, const uint8_t *tlv, uint16_t size) |
876c9d3a | 208 | { |
75b6a61a | 209 | struct mrvl_ie_header *tlv_h; |
5844d12e DW |
210 | uint16_t length; |
211 | ssize_t pos = 0; | |
212 | ||
3a188649 | 213 | while (pos < size) { |
75b6a61a | 214 | tlv_h = (struct mrvl_ie_header *) tlv; |
5844d12e | 215 | if (!tlv_h->len) |
3a188649 | 216 | return NULL; |
5844d12e DW |
217 | if (tlv_h->type == cpu_to_le16(tlv_type)) |
218 | return tlv_h; | |
219 | length = le16_to_cpu(tlv_h->len) + sizeof(*tlv_h); | |
3a188649 HS |
220 | pos += length; |
221 | tlv += length; | |
222 | } | |
223 | return NULL; | |
876c9d3a MT |
224 | } |
225 | ||
3a188649 | 226 | |
5844d12e DW |
227 | static ssize_t lbs_threshold_read(uint16_t tlv_type, uint16_t event_mask, |
228 | struct file *file, char __user *userbuf, | |
229 | size_t count, loff_t *ppos) | |
876c9d3a | 230 | { |
5844d12e | 231 | struct cmd_ds_802_11_subscribe_event *subscribed; |
75b6a61a | 232 | struct mrvl_ie_thresholds *got; |
69f9032d | 233 | struct lbs_private *priv = file->private_data; |
5844d12e | 234 | ssize_t ret = 0; |
3a188649 | 235 | size_t pos = 0; |
5844d12e | 236 | char *buf; |
3a188649 HS |
237 | u8 value; |
238 | u8 freq; | |
b6b8abe4 | 239 | int events = 0; |
876c9d3a | 240 | |
5844d12e DW |
241 | buf = (char *)get_zeroed_page(GFP_KERNEL); |
242 | if (!buf) | |
243 | return -ENOMEM; | |
876c9d3a | 244 | |
5844d12e DW |
245 | subscribed = kzalloc(sizeof(*subscribed), GFP_KERNEL); |
246 | if (!subscribed) { | |
247 | ret = -ENOMEM; | |
248 | goto out_page; | |
876c9d3a MT |
249 | } |
250 | ||
5844d12e DW |
251 | subscribed->hdr.size = cpu_to_le16(sizeof(*subscribed)); |
252 | subscribed->action = cpu_to_le16(CMD_ACT_GET); | |
253 | ||
254 | ret = lbs_cmd_with_response(priv, CMD_802_11_SUBSCRIBE_EVENT, subscribed); | |
255 | if (ret) | |
256 | goto out_cmd; | |
257 | ||
b6b8abe4 | 258 | got = lbs_tlv_find(tlv_type, subscribed->tlv, sizeof(subscribed->tlv)); |
3a188649 HS |
259 | if (got) { |
260 | value = got->value; | |
261 | freq = got->freq; | |
b6b8abe4 | 262 | events = le16_to_cpu(subscribed->events); |
876c9d3a | 263 | |
3a188649 | 264 | pos += snprintf(buf, len, "%d %d %d\n", value, freq, |
5844d12e DW |
265 | !!(events & event_mask)); |
266 | } | |
876c9d3a | 267 | |
5844d12e | 268 | ret = simple_read_from_buffer(userbuf, count, ppos, buf, pos); |
876c9d3a | 269 | |
5844d12e DW |
270 | out_cmd: |
271 | kfree(subscribed); | |
272 | ||
273 | out_page: | |
274 | free_page((unsigned long)buf); | |
275 | return ret; | |
876c9d3a MT |
276 | } |
277 | ||
876c9d3a | 278 | |
5844d12e DW |
279 | static ssize_t lbs_threshold_write(uint16_t tlv_type, uint16_t event_mask, |
280 | struct file *file, | |
281 | const char __user *userbuf, size_t count, | |
282 | loff_t *ppos) | |
876c9d3a | 283 | { |
3a188649 | 284 | struct cmd_ds_802_11_subscribe_event *events; |
75b6a61a | 285 | struct mrvl_ie_thresholds *tlv; |
5844d12e DW |
286 | struct lbs_private *priv = file->private_data; |
287 | ssize_t buf_size; | |
288 | int value, freq, new_mask; | |
289 | uint16_t curr_mask; | |
290 | char *buf; | |
291 | int ret; | |
292 | ||
293 | buf = (char *)get_zeroed_page(GFP_KERNEL); | |
294 | if (!buf) | |
295 | return -ENOMEM; | |
876c9d3a MT |
296 | |
297 | buf_size = min(count, len - 1); | |
298 | if (copy_from_user(buf, userbuf, buf_size)) { | |
5844d12e DW |
299 | ret = -EFAULT; |
300 | goto out_page; | |
876c9d3a | 301 | } |
5844d12e DW |
302 | ret = sscanf(buf, "%d %d %d", &value, &freq, &new_mask); |
303 | if (ret != 3) { | |
304 | ret = -EINVAL; | |
305 | goto out_page; | |
306 | } | |
307 | events = kzalloc(sizeof(*events), GFP_KERNEL); | |
308 | if (!events) { | |
309 | ret = -ENOMEM; | |
310 | goto out_page; | |
876c9d3a | 311 | } |
5844d12e DW |
312 | |
313 | events->hdr.size = cpu_to_le16(sizeof(*events)); | |
314 | events->action = cpu_to_le16(CMD_ACT_GET); | |
315 | ||
316 | ret = lbs_cmd_with_response(priv, CMD_802_11_SUBSCRIBE_EVENT, events); | |
317 | if (ret) | |
318 | goto out_events; | |
319 | ||
320 | curr_mask = le16_to_cpu(events->events); | |
876c9d3a | 321 | |
3a188649 HS |
322 | if (new_mask) |
323 | new_mask = curr_mask | event_mask; | |
324 | else | |
325 | new_mask = curr_mask & ~event_mask; | |
326 | ||
327 | /* Now everything is set and we can send stuff down to the firmware */ | |
876c9d3a | 328 | |
5844d12e DW |
329 | tlv = (void *)events->tlv; |
330 | ||
331 | events->action = cpu_to_le16(CMD_ACT_SET); | |
332 | events->events = cpu_to_le16(new_mask); | |
333 | tlv->header.type = cpu_to_le16(tlv_type); | |
334 | tlv->header.len = cpu_to_le16(sizeof(*tlv) - sizeof(tlv->header)); | |
335 | tlv->value = value; | |
336 | if (tlv_type != TLV_TYPE_BCNMISS) | |
337 | tlv->freq = freq; | |
338 | ||
a75eda43 HS |
339 | /* The command header, the action, the event mask, and one TLV */ |
340 | events->hdr.size = cpu_to_le16(sizeof(events->hdr) + 4 + sizeof(*tlv)); | |
5844d12e DW |
341 | |
342 | ret = lbs_cmd_with_response(priv, CMD_802_11_SUBSCRIBE_EVENT, events); | |
343 | ||
344 | if (!ret) | |
345 | ret = count; | |
346 | out_events: | |
347 | kfree(events); | |
348 | out_page: | |
349 | free_page((unsigned long)buf); | |
350 | return ret; | |
876c9d3a MT |
351 | } |
352 | ||
876c9d3a | 353 | |
5844d12e DW |
354 | static ssize_t lbs_lowrssi_read(struct file *file, char __user *userbuf, |
355 | size_t count, loff_t *ppos) | |
876c9d3a | 356 | { |
3a188649 | 357 | return lbs_threshold_read(TLV_TYPE_RSSI_LOW, CMD_SUBSCRIBE_RSSI_LOW, |
5844d12e | 358 | file, userbuf, count, ppos); |
876c9d3a MT |
359 | } |
360 | ||
876c9d3a | 361 | |
5844d12e DW |
362 | static ssize_t lbs_lowrssi_write(struct file *file, const char __user *userbuf, |
363 | size_t count, loff_t *ppos) | |
3a188649 HS |
364 | { |
365 | return lbs_threshold_write(TLV_TYPE_RSSI_LOW, CMD_SUBSCRIBE_RSSI_LOW, | |
5844d12e | 366 | file, userbuf, count, ppos); |
3a188649 | 367 | } |
876c9d3a | 368 | |
876c9d3a | 369 | |
5844d12e DW |
370 | static ssize_t lbs_lowsnr_read(struct file *file, char __user *userbuf, |
371 | size_t count, loff_t *ppos) | |
3a188649 HS |
372 | { |
373 | return lbs_threshold_read(TLV_TYPE_SNR_LOW, CMD_SUBSCRIBE_SNR_LOW, | |
5844d12e | 374 | file, userbuf, count, ppos); |
3a188649 | 375 | } |
876c9d3a | 376 | |
876c9d3a | 377 | |
5844d12e DW |
378 | static ssize_t lbs_lowsnr_write(struct file *file, const char __user *userbuf, |
379 | size_t count, loff_t *ppos) | |
3a188649 HS |
380 | { |
381 | return lbs_threshold_write(TLV_TYPE_SNR_LOW, CMD_SUBSCRIBE_SNR_LOW, | |
5844d12e | 382 | file, userbuf, count, ppos); |
3a188649 | 383 | } |
876c9d3a | 384 | |
876c9d3a | 385 | |
5844d12e DW |
386 | static ssize_t lbs_failcount_read(struct file *file, char __user *userbuf, |
387 | size_t count, loff_t *ppos) | |
3a188649 HS |
388 | { |
389 | return lbs_threshold_read(TLV_TYPE_FAILCOUNT, CMD_SUBSCRIBE_FAILCOUNT, | |
5844d12e | 390 | file, userbuf, count, ppos); |
3a188649 | 391 | } |
876c9d3a | 392 | |
876c9d3a | 393 | |
5844d12e DW |
394 | static ssize_t lbs_failcount_write(struct file *file, const char __user *userbuf, |
395 | size_t count, loff_t *ppos) | |
3a188649 HS |
396 | { |
397 | return lbs_threshold_write(TLV_TYPE_FAILCOUNT, CMD_SUBSCRIBE_FAILCOUNT, | |
5844d12e | 398 | file, userbuf, count, ppos); |
876c9d3a MT |
399 | } |
400 | ||
3a188649 | 401 | |
5844d12e DW |
402 | static ssize_t lbs_highrssi_read(struct file *file, char __user *userbuf, |
403 | size_t count, loff_t *ppos) | |
876c9d3a | 404 | { |
3a188649 | 405 | return lbs_threshold_read(TLV_TYPE_RSSI_HIGH, CMD_SUBSCRIBE_RSSI_HIGH, |
5844d12e | 406 | file, userbuf, count, ppos); |
3a188649 | 407 | } |
876c9d3a | 408 | |
876c9d3a | 409 | |
5844d12e DW |
410 | static ssize_t lbs_highrssi_write(struct file *file, const char __user *userbuf, |
411 | size_t count, loff_t *ppos) | |
3a188649 HS |
412 | { |
413 | return lbs_threshold_write(TLV_TYPE_RSSI_HIGH, CMD_SUBSCRIBE_RSSI_HIGH, | |
5844d12e | 414 | file, userbuf, count, ppos); |
3a188649 | 415 | } |
876c9d3a | 416 | |
876c9d3a | 417 | |
5844d12e DW |
418 | static ssize_t lbs_highsnr_read(struct file *file, char __user *userbuf, |
419 | size_t count, loff_t *ppos) | |
3a188649 HS |
420 | { |
421 | return lbs_threshold_read(TLV_TYPE_SNR_HIGH, CMD_SUBSCRIBE_SNR_HIGH, | |
5844d12e | 422 | file, userbuf, count, ppos); |
3a188649 | 423 | } |
876c9d3a | 424 | |
876c9d3a | 425 | |
5844d12e DW |
426 | static ssize_t lbs_highsnr_write(struct file *file, const char __user *userbuf, |
427 | size_t count, loff_t *ppos) | |
3a188649 HS |
428 | { |
429 | return lbs_threshold_write(TLV_TYPE_SNR_HIGH, CMD_SUBSCRIBE_SNR_HIGH, | |
5844d12e | 430 | file, userbuf, count, ppos); |
876c9d3a MT |
431 | } |
432 | ||
5844d12e DW |
433 | static ssize_t lbs_bcnmiss_read(struct file *file, char __user *userbuf, |
434 | size_t count, loff_t *ppos) | |
876c9d3a | 435 | { |
3a188649 | 436 | return lbs_threshold_read(TLV_TYPE_BCNMISS, CMD_SUBSCRIBE_BCNMISS, |
5844d12e | 437 | file, userbuf, count, ppos); |
3a188649 | 438 | } |
876c9d3a | 439 | |
876c9d3a | 440 | |
5844d12e DW |
441 | static ssize_t lbs_bcnmiss_write(struct file *file, const char __user *userbuf, |
442 | size_t count, loff_t *ppos) | |
3a188649 HS |
443 | { |
444 | return lbs_threshold_write(TLV_TYPE_BCNMISS, CMD_SUBSCRIBE_BCNMISS, | |
5844d12e | 445 | file, userbuf, count, ppos); |
876c9d3a MT |
446 | } |
447 | ||
876c9d3a | 448 | |
876c9d3a | 449 | |
10078321 | 450 | static ssize_t lbs_rdmac_read(struct file *file, char __user *userbuf, |
876c9d3a MT |
451 | size_t count, loff_t *ppos) |
452 | { | |
69f9032d | 453 | struct lbs_private *priv = file->private_data; |
10078321 | 454 | struct lbs_offset_value offval; |
876c9d3a MT |
455 | ssize_t pos = 0; |
456 | int ret; | |
457 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
458 | char *buf = (char *)addr; | |
ad43f8bf KD |
459 | if (!buf) |
460 | return -ENOMEM; | |
876c9d3a MT |
461 | |
462 | offval.offset = priv->mac_offset; | |
463 | offval.value = 0; | |
464 | ||
10078321 | 465 | ret = lbs_prepare_and_send_command(priv, |
0aef64d7 DW |
466 | CMD_MAC_REG_ACCESS, 0, |
467 | CMD_OPTION_WAITFORRSP, 0, &offval); | |
876c9d3a | 468 | mdelay(10); |
c0bbd576 AK |
469 | if (!ret) { |
470 | pos += snprintf(buf+pos, len-pos, "MAC[0x%x] = 0x%08x\n", | |
aa21c004 | 471 | priv->mac_offset, priv->offsetvalue.value); |
876c9d3a | 472 | |
c0bbd576 AK |
473 | ret = simple_read_from_buffer(userbuf, count, ppos, buf, pos); |
474 | } | |
876c9d3a MT |
475 | free_page(addr); |
476 | return ret; | |
477 | } | |
478 | ||
10078321 | 479 | static ssize_t lbs_rdmac_write(struct file *file, |
876c9d3a MT |
480 | const char __user *userbuf, |
481 | size_t count, loff_t *ppos) | |
482 | { | |
69f9032d | 483 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
484 | ssize_t res, buf_size; |
485 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
486 | char *buf = (char *)addr; | |
ad43f8bf KD |
487 | if (!buf) |
488 | return -ENOMEM; | |
876c9d3a MT |
489 | |
490 | buf_size = min(count, len - 1); | |
491 | if (copy_from_user(buf, userbuf, buf_size)) { | |
492 | res = -EFAULT; | |
493 | goto out_unlock; | |
494 | } | |
495 | priv->mac_offset = simple_strtoul((char *)buf, NULL, 16); | |
496 | res = count; | |
497 | out_unlock: | |
498 | free_page(addr); | |
499 | return res; | |
500 | } | |
501 | ||
10078321 | 502 | static ssize_t lbs_wrmac_write(struct file *file, |
876c9d3a MT |
503 | const char __user *userbuf, |
504 | size_t count, loff_t *ppos) | |
505 | { | |
506 | ||
69f9032d | 507 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
508 | ssize_t res, buf_size; |
509 | u32 offset, value; | |
10078321 | 510 | struct lbs_offset_value offval; |
876c9d3a MT |
511 | unsigned long addr = get_zeroed_page(GFP_KERNEL); |
512 | char *buf = (char *)addr; | |
ad43f8bf KD |
513 | if (!buf) |
514 | return -ENOMEM; | |
876c9d3a MT |
515 | |
516 | buf_size = min(count, len - 1); | |
517 | if (copy_from_user(buf, userbuf, buf_size)) { | |
518 | res = -EFAULT; | |
519 | goto out_unlock; | |
520 | } | |
521 | res = sscanf(buf, "%x %x", &offset, &value); | |
522 | if (res != 2) { | |
523 | res = -EFAULT; | |
524 | goto out_unlock; | |
525 | } | |
526 | ||
527 | offval.offset = offset; | |
528 | offval.value = value; | |
10078321 | 529 | res = lbs_prepare_and_send_command(priv, |
0aef64d7 DW |
530 | CMD_MAC_REG_ACCESS, 1, |
531 | CMD_OPTION_WAITFORRSP, 0, &offval); | |
876c9d3a MT |
532 | mdelay(10); |
533 | ||
c0bbd576 AK |
534 | if (!res) |
535 | res = count; | |
876c9d3a MT |
536 | out_unlock: |
537 | free_page(addr); | |
538 | return res; | |
539 | } | |
540 | ||
10078321 | 541 | static ssize_t lbs_rdbbp_read(struct file *file, char __user *userbuf, |
876c9d3a MT |
542 | size_t count, loff_t *ppos) |
543 | { | |
69f9032d | 544 | struct lbs_private *priv = file->private_data; |
10078321 | 545 | struct lbs_offset_value offval; |
876c9d3a MT |
546 | ssize_t pos = 0; |
547 | int ret; | |
548 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
549 | char *buf = (char *)addr; | |
ad43f8bf KD |
550 | if (!buf) |
551 | return -ENOMEM; | |
876c9d3a MT |
552 | |
553 | offval.offset = priv->bbp_offset; | |
554 | offval.value = 0; | |
555 | ||
10078321 | 556 | ret = lbs_prepare_and_send_command(priv, |
0aef64d7 DW |
557 | CMD_BBP_REG_ACCESS, 0, |
558 | CMD_OPTION_WAITFORRSP, 0, &offval); | |
876c9d3a | 559 | mdelay(10); |
c0bbd576 AK |
560 | if (!ret) { |
561 | pos += snprintf(buf+pos, len-pos, "BBP[0x%x] = 0x%08x\n", | |
aa21c004 | 562 | priv->bbp_offset, priv->offsetvalue.value); |
876c9d3a | 563 | |
c0bbd576 AK |
564 | ret = simple_read_from_buffer(userbuf, count, ppos, buf, pos); |
565 | } | |
876c9d3a MT |
566 | free_page(addr); |
567 | ||
568 | return ret; | |
569 | } | |
570 | ||
10078321 | 571 | static ssize_t lbs_rdbbp_write(struct file *file, |
876c9d3a MT |
572 | const char __user *userbuf, |
573 | size_t count, loff_t *ppos) | |
574 | { | |
69f9032d | 575 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
576 | ssize_t res, buf_size; |
577 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
578 | char *buf = (char *)addr; | |
ad43f8bf KD |
579 | if (!buf) |
580 | return -ENOMEM; | |
876c9d3a MT |
581 | |
582 | buf_size = min(count, len - 1); | |
583 | if (copy_from_user(buf, userbuf, buf_size)) { | |
584 | res = -EFAULT; | |
585 | goto out_unlock; | |
586 | } | |
587 | priv->bbp_offset = simple_strtoul((char *)buf, NULL, 16); | |
588 | res = count; | |
589 | out_unlock: | |
590 | free_page(addr); | |
591 | return res; | |
592 | } | |
593 | ||
10078321 | 594 | static ssize_t lbs_wrbbp_write(struct file *file, |
876c9d3a MT |
595 | const char __user *userbuf, |
596 | size_t count, loff_t *ppos) | |
597 | { | |
598 | ||
69f9032d | 599 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
600 | ssize_t res, buf_size; |
601 | u32 offset, value; | |
10078321 | 602 | struct lbs_offset_value offval; |
876c9d3a MT |
603 | unsigned long addr = get_zeroed_page(GFP_KERNEL); |
604 | char *buf = (char *)addr; | |
ad43f8bf KD |
605 | if (!buf) |
606 | return -ENOMEM; | |
876c9d3a MT |
607 | |
608 | buf_size = min(count, len - 1); | |
609 | if (copy_from_user(buf, userbuf, buf_size)) { | |
610 | res = -EFAULT; | |
611 | goto out_unlock; | |
612 | } | |
613 | res = sscanf(buf, "%x %x", &offset, &value); | |
614 | if (res != 2) { | |
615 | res = -EFAULT; | |
616 | goto out_unlock; | |
617 | } | |
618 | ||
619 | offval.offset = offset; | |
620 | offval.value = value; | |
10078321 | 621 | res = lbs_prepare_and_send_command(priv, |
0aef64d7 DW |
622 | CMD_BBP_REG_ACCESS, 1, |
623 | CMD_OPTION_WAITFORRSP, 0, &offval); | |
876c9d3a MT |
624 | mdelay(10); |
625 | ||
c0bbd576 AK |
626 | if (!res) |
627 | res = count; | |
876c9d3a MT |
628 | out_unlock: |
629 | free_page(addr); | |
630 | return res; | |
631 | } | |
632 | ||
10078321 | 633 | static ssize_t lbs_rdrf_read(struct file *file, char __user *userbuf, |
876c9d3a MT |
634 | size_t count, loff_t *ppos) |
635 | { | |
69f9032d | 636 | struct lbs_private *priv = file->private_data; |
10078321 | 637 | struct lbs_offset_value offval; |
876c9d3a MT |
638 | ssize_t pos = 0; |
639 | int ret; | |
640 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
641 | char *buf = (char *)addr; | |
ad43f8bf KD |
642 | if (!buf) |
643 | return -ENOMEM; | |
876c9d3a MT |
644 | |
645 | offval.offset = priv->rf_offset; | |
646 | offval.value = 0; | |
647 | ||
10078321 | 648 | ret = lbs_prepare_and_send_command(priv, |
0aef64d7 DW |
649 | CMD_RF_REG_ACCESS, 0, |
650 | CMD_OPTION_WAITFORRSP, 0, &offval); | |
876c9d3a | 651 | mdelay(10); |
c0bbd576 AK |
652 | if (!ret) { |
653 | pos += snprintf(buf+pos, len-pos, "RF[0x%x] = 0x%08x\n", | |
aa21c004 | 654 | priv->rf_offset, priv->offsetvalue.value); |
876c9d3a | 655 | |
c0bbd576 AK |
656 | ret = simple_read_from_buffer(userbuf, count, ppos, buf, pos); |
657 | } | |
876c9d3a MT |
658 | free_page(addr); |
659 | ||
660 | return ret; | |
661 | } | |
662 | ||
10078321 | 663 | static ssize_t lbs_rdrf_write(struct file *file, |
876c9d3a MT |
664 | const char __user *userbuf, |
665 | size_t count, loff_t *ppos) | |
666 | { | |
69f9032d | 667 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
668 | ssize_t res, buf_size; |
669 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
670 | char *buf = (char *)addr; | |
ad43f8bf KD |
671 | if (!buf) |
672 | return -ENOMEM; | |
876c9d3a MT |
673 | |
674 | buf_size = min(count, len - 1); | |
675 | if (copy_from_user(buf, userbuf, buf_size)) { | |
676 | res = -EFAULT; | |
677 | goto out_unlock; | |
678 | } | |
4101dec9 | 679 | priv->rf_offset = simple_strtoul(buf, NULL, 16); |
876c9d3a MT |
680 | res = count; |
681 | out_unlock: | |
682 | free_page(addr); | |
683 | return res; | |
684 | } | |
685 | ||
10078321 | 686 | static ssize_t lbs_wrrf_write(struct file *file, |
876c9d3a MT |
687 | const char __user *userbuf, |
688 | size_t count, loff_t *ppos) | |
689 | { | |
690 | ||
69f9032d | 691 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
692 | ssize_t res, buf_size; |
693 | u32 offset, value; | |
10078321 | 694 | struct lbs_offset_value offval; |
876c9d3a MT |
695 | unsigned long addr = get_zeroed_page(GFP_KERNEL); |
696 | char *buf = (char *)addr; | |
ad43f8bf KD |
697 | if (!buf) |
698 | return -ENOMEM; | |
876c9d3a MT |
699 | |
700 | buf_size = min(count, len - 1); | |
701 | if (copy_from_user(buf, userbuf, buf_size)) { | |
702 | res = -EFAULT; | |
703 | goto out_unlock; | |
704 | } | |
705 | res = sscanf(buf, "%x %x", &offset, &value); | |
706 | if (res != 2) { | |
707 | res = -EFAULT; | |
708 | goto out_unlock; | |
709 | } | |
710 | ||
711 | offval.offset = offset; | |
712 | offval.value = value; | |
10078321 | 713 | res = lbs_prepare_and_send_command(priv, |
0aef64d7 DW |
714 | CMD_RF_REG_ACCESS, 1, |
715 | CMD_OPTION_WAITFORRSP, 0, &offval); | |
876c9d3a MT |
716 | mdelay(10); |
717 | ||
c0bbd576 AK |
718 | if (!res) |
719 | res = count; | |
876c9d3a MT |
720 | out_unlock: |
721 | free_page(addr); | |
722 | return res; | |
723 | } | |
724 | ||
725 | #define FOPS(fread, fwrite) { \ | |
726 | .owner = THIS_MODULE, \ | |
727 | .open = open_file_generic, \ | |
728 | .read = (fread), \ | |
729 | .write = (fwrite), \ | |
730 | } | |
731 | ||
10078321 | 732 | struct lbs_debugfs_files { |
4101dec9 | 733 | const char *name; |
876c9d3a MT |
734 | int perm; |
735 | struct file_operations fops; | |
736 | }; | |
737 | ||
4101dec9 | 738 | static const struct lbs_debugfs_files debugfs_files[] = { |
10078321 | 739 | { "info", 0444, FOPS(lbs_dev_info, write_file_dummy), }, |
10078321 HS |
740 | { "sleepparams", 0644, FOPS(lbs_sleepparams_read, |
741 | lbs_sleepparams_write), }, | |
1311843c AK |
742 | { "hostsleep", 0644, FOPS(lbs_host_sleep_read, |
743 | lbs_host_sleep_write), }, | |
876c9d3a MT |
744 | }; |
745 | ||
4101dec9 | 746 | static const struct lbs_debugfs_files debugfs_events_files[] = { |
10078321 HS |
747 | {"low_rssi", 0644, FOPS(lbs_lowrssi_read, |
748 | lbs_lowrssi_write), }, | |
749 | {"low_snr", 0644, FOPS(lbs_lowsnr_read, | |
750 | lbs_lowsnr_write), }, | |
751 | {"failure_count", 0644, FOPS(lbs_failcount_read, | |
752 | lbs_failcount_write), }, | |
753 | {"beacon_missed", 0644, FOPS(lbs_bcnmiss_read, | |
754 | lbs_bcnmiss_write), }, | |
755 | {"high_rssi", 0644, FOPS(lbs_highrssi_read, | |
756 | lbs_highrssi_write), }, | |
757 | {"high_snr", 0644, FOPS(lbs_highsnr_read, | |
758 | lbs_highsnr_write), }, | |
876c9d3a MT |
759 | }; |
760 | ||
4101dec9 | 761 | static const struct lbs_debugfs_files debugfs_regs_files[] = { |
10078321 HS |
762 | {"rdmac", 0644, FOPS(lbs_rdmac_read, lbs_rdmac_write), }, |
763 | {"wrmac", 0600, FOPS(NULL, lbs_wrmac_write), }, | |
764 | {"rdbbp", 0644, FOPS(lbs_rdbbp_read, lbs_rdbbp_write), }, | |
765 | {"wrbbp", 0600, FOPS(NULL, lbs_wrbbp_write), }, | |
766 | {"rdrf", 0644, FOPS(lbs_rdrf_read, lbs_rdrf_write), }, | |
767 | {"wrrf", 0600, FOPS(NULL, lbs_wrrf_write), }, | |
876c9d3a MT |
768 | }; |
769 | ||
10078321 | 770 | void lbs_debugfs_init(void) |
876c9d3a | 771 | { |
10078321 HS |
772 | if (!lbs_dir) |
773 | lbs_dir = debugfs_create_dir("lbs_wireless", NULL); | |
876c9d3a MT |
774 | } |
775 | ||
10078321 | 776 | void lbs_debugfs_remove(void) |
876c9d3a | 777 | { |
10078321 HS |
778 | if (lbs_dir) |
779 | debugfs_remove(lbs_dir); | |
876c9d3a MT |
780 | } |
781 | ||
69f9032d | 782 | void lbs_debugfs_init_one(struct lbs_private *priv, struct net_device *dev) |
876c9d3a MT |
783 | { |
784 | int i; | |
4101dec9 | 785 | const struct lbs_debugfs_files *files; |
10078321 | 786 | if (!lbs_dir) |
876c9d3a MT |
787 | goto exit; |
788 | ||
10078321 | 789 | priv->debugfs_dir = debugfs_create_dir(dev->name, lbs_dir); |
876c9d3a MT |
790 | if (!priv->debugfs_dir) |
791 | goto exit; | |
792 | ||
793 | for (i=0; i<ARRAY_SIZE(debugfs_files); i++) { | |
794 | files = &debugfs_files[i]; | |
795 | priv->debugfs_files[i] = debugfs_create_file(files->name, | |
796 | files->perm, | |
797 | priv->debugfs_dir, | |
798 | priv, | |
799 | &files->fops); | |
800 | } | |
801 | ||
802 | priv->events_dir = debugfs_create_dir("subscribed_events", priv->debugfs_dir); | |
803 | if (!priv->events_dir) | |
804 | goto exit; | |
805 | ||
806 | for (i=0; i<ARRAY_SIZE(debugfs_events_files); i++) { | |
807 | files = &debugfs_events_files[i]; | |
808 | priv->debugfs_events_files[i] = debugfs_create_file(files->name, | |
809 | files->perm, | |
810 | priv->events_dir, | |
811 | priv, | |
812 | &files->fops); | |
813 | } | |
814 | ||
815 | priv->regs_dir = debugfs_create_dir("registers", priv->debugfs_dir); | |
816 | if (!priv->regs_dir) | |
817 | goto exit; | |
818 | ||
819 | for (i=0; i<ARRAY_SIZE(debugfs_regs_files); i++) { | |
820 | files = &debugfs_regs_files[i]; | |
821 | priv->debugfs_regs_files[i] = debugfs_create_file(files->name, | |
822 | files->perm, | |
823 | priv->regs_dir, | |
824 | priv, | |
825 | &files->fops); | |
826 | } | |
827 | ||
828 | #ifdef PROC_DEBUG | |
e98a88dd | 829 | lbs_debug_init(priv); |
876c9d3a MT |
830 | #endif |
831 | exit: | |
832 | return; | |
833 | } | |
834 | ||
69f9032d | 835 | void lbs_debugfs_remove_one(struct lbs_private *priv) |
876c9d3a MT |
836 | { |
837 | int i; | |
838 | ||
839 | for(i=0; i<ARRAY_SIZE(debugfs_regs_files); i++) | |
840 | debugfs_remove(priv->debugfs_regs_files[i]); | |
841 | ||
842 | debugfs_remove(priv->regs_dir); | |
843 | ||
0b7db956 | 844 | for(i=0; i<ARRAY_SIZE(debugfs_events_files); i++) |
876c9d3a MT |
845 | debugfs_remove(priv->debugfs_events_files[i]); |
846 | ||
847 | debugfs_remove(priv->events_dir); | |
848 | #ifdef PROC_DEBUG | |
849 | debugfs_remove(priv->debugfs_debug); | |
850 | #endif | |
851 | for(i=0; i<ARRAY_SIZE(debugfs_files); i++) | |
852 | debugfs_remove(priv->debugfs_files[i]); | |
0b7db956 | 853 | debugfs_remove(priv->debugfs_dir); |
876c9d3a MT |
854 | } |
855 | ||
46868202 HS |
856 | |
857 | ||
876c9d3a MT |
858 | /* debug entry */ |
859 | ||
46868202 HS |
860 | #ifdef PROC_DEBUG |
861 | ||
aa21c004 DW |
862 | #define item_size(n) (FIELD_SIZEOF(struct lbs_private, n)) |
863 | #define item_addr(n) (offsetof(struct lbs_private, n)) | |
876c9d3a | 864 | |
46868202 | 865 | |
876c9d3a MT |
866 | struct debug_data { |
867 | char name[32]; | |
868 | u32 size; | |
4269e2ad | 869 | size_t addr; |
876c9d3a MT |
870 | }; |
871 | ||
aa21c004 | 872 | /* To debug any member of struct lbs_private, simply add one line here. |
876c9d3a MT |
873 | */ |
874 | static struct debug_data items[] = { | |
876c9d3a MT |
875 | {"psmode", item_size(psmode), item_addr(psmode)}, |
876 | {"psstate", item_size(psstate), item_addr(psstate)}, | |
877 | }; | |
878 | ||
d2f11e09 | 879 | static int num_of_items = ARRAY_SIZE(items); |
876c9d3a MT |
880 | |
881 | /** | |
882 | * @brief proc read function | |
883 | * | |
884 | * @param page pointer to buffer | |
885 | * @param s read data starting position | |
886 | * @param off offset | |
887 | * @param cnt counter | |
888 | * @param eof end of file flag | |
889 | * @param data data to output | |
890 | * @return number of output data | |
891 | */ | |
10078321 | 892 | static ssize_t lbs_debugfs_read(struct file *file, char __user *userbuf, |
876c9d3a MT |
893 | size_t count, loff_t *ppos) |
894 | { | |
895 | int val = 0; | |
896 | size_t pos = 0; | |
897 | ssize_t res; | |
898 | char *p; | |
899 | int i; | |
900 | struct debug_data *d; | |
901 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
902 | char *buf = (char *)addr; | |
ad43f8bf KD |
903 | if (!buf) |
904 | return -ENOMEM; | |
876c9d3a MT |
905 | |
906 | p = buf; | |
907 | ||
908 | d = (struct debug_data *)file->private_data; | |
909 | ||
910 | for (i = 0; i < num_of_items; i++) { | |
911 | if (d[i].size == 1) | |
912 | val = *((u8 *) d[i].addr); | |
913 | else if (d[i].size == 2) | |
914 | val = *((u16 *) d[i].addr); | |
915 | else if (d[i].size == 4) | |
916 | val = *((u32 *) d[i].addr); | |
4269e2ad DW |
917 | else if (d[i].size == 8) |
918 | val = *((u64 *) d[i].addr); | |
876c9d3a MT |
919 | |
920 | pos += sprintf(p + pos, "%s=%d\n", d[i].name, val); | |
921 | } | |
922 | ||
923 | res = simple_read_from_buffer(userbuf, count, ppos, p, pos); | |
924 | ||
925 | free_page(addr); | |
926 | return res; | |
927 | } | |
928 | ||
929 | /** | |
930 | * @brief proc write function | |
931 | * | |
932 | * @param f file pointer | |
933 | * @param buf pointer to data buffer | |
934 | * @param cnt data number to write | |
935 | * @param data data to write | |
936 | * @return number of data | |
937 | */ | |
10078321 | 938 | static ssize_t lbs_debugfs_write(struct file *f, const char __user *buf, |
876c9d3a MT |
939 | size_t cnt, loff_t *ppos) |
940 | { | |
941 | int r, i; | |
942 | char *pdata; | |
943 | char *p; | |
944 | char *p0; | |
945 | char *p1; | |
946 | char *p2; | |
947 | struct debug_data *d = (struct debug_data *)f->private_data; | |
948 | ||
655b4d16 | 949 | pdata = kmalloc(cnt, GFP_KERNEL); |
876c9d3a MT |
950 | if (pdata == NULL) |
951 | return 0; | |
952 | ||
953 | if (copy_from_user(pdata, buf, cnt)) { | |
9012b28a | 954 | lbs_deb_debugfs("Copy from user failed\n"); |
876c9d3a MT |
955 | kfree(pdata); |
956 | return 0; | |
957 | } | |
958 | ||
959 | p0 = pdata; | |
960 | for (i = 0; i < num_of_items; i++) { | |
961 | do { | |
962 | p = strstr(p0, d[i].name); | |
963 | if (p == NULL) | |
964 | break; | |
965 | p1 = strchr(p, '\n'); | |
966 | if (p1 == NULL) | |
967 | break; | |
968 | p0 = p1++; | |
969 | p2 = strchr(p, '='); | |
970 | if (!p2) | |
971 | break; | |
972 | p2++; | |
d2f11e09 | 973 | r = simple_strtoul(p2, NULL, 0); |
876c9d3a MT |
974 | if (d[i].size == 1) |
975 | *((u8 *) d[i].addr) = (u8) r; | |
976 | else if (d[i].size == 2) | |
977 | *((u16 *) d[i].addr) = (u16) r; | |
978 | else if (d[i].size == 4) | |
979 | *((u32 *) d[i].addr) = (u32) r; | |
4269e2ad DW |
980 | else if (d[i].size == 8) |
981 | *((u64 *) d[i].addr) = (u64) r; | |
876c9d3a MT |
982 | break; |
983 | } while (1); | |
984 | } | |
985 | kfree(pdata); | |
986 | ||
4269e2ad | 987 | return (ssize_t)cnt; |
876c9d3a MT |
988 | } |
989 | ||
4101dec9 | 990 | static const struct file_operations lbs_debug_fops = { |
876c9d3a MT |
991 | .owner = THIS_MODULE, |
992 | .open = open_file_generic, | |
10078321 HS |
993 | .write = lbs_debugfs_write, |
994 | .read = lbs_debugfs_read, | |
876c9d3a MT |
995 | }; |
996 | ||
997 | /** | |
998 | * @brief create debug proc file | |
999 | * | |
69f9032d | 1000 | * @param priv pointer struct lbs_private |
876c9d3a MT |
1001 | * @param dev pointer net_device |
1002 | * @return N/A | |
1003 | */ | |
e98a88dd | 1004 | static void lbs_debug_init(struct lbs_private *priv) |
876c9d3a MT |
1005 | { |
1006 | int i; | |
1007 | ||
1008 | if (!priv->debugfs_dir) | |
1009 | return; | |
1010 | ||
1011 | for (i = 0; i < num_of_items; i++) | |
aa21c004 | 1012 | items[i].addr += (size_t) priv; |
876c9d3a MT |
1013 | |
1014 | priv->debugfs_debug = debugfs_create_file("debug", 0644, | |
1015 | priv->debugfs_dir, &items[0], | |
10078321 | 1016 | &lbs_debug_fops); |
876c9d3a | 1017 | } |
46868202 | 1018 | #endif |