]>
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 | |
10078321 | 449 | static ssize_t lbs_rdmac_read(struct file *file, char __user *userbuf, |
876c9d3a MT |
450 | size_t count, loff_t *ppos) |
451 | { | |
69f9032d | 452 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
453 | ssize_t pos = 0; |
454 | int ret; | |
455 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
456 | char *buf = (char *)addr; | |
4c7c6e00 DW |
457 | u32 val = 0; |
458 | ||
ad43f8bf KD |
459 | if (!buf) |
460 | return -ENOMEM; | |
876c9d3a | 461 | |
4c7c6e00 | 462 | ret = lbs_get_reg(priv, CMD_MAC_REG_ACCESS, priv->mac_offset, &val); |
876c9d3a | 463 | mdelay(10); |
c0bbd576 | 464 | if (!ret) { |
4c7c6e00 DW |
465 | pos = snprintf(buf, len, "MAC[0x%x] = 0x%08x\n", |
466 | priv->mac_offset, val); | |
c0bbd576 AK |
467 | ret = simple_read_from_buffer(userbuf, count, ppos, buf, pos); |
468 | } | |
876c9d3a MT |
469 | free_page(addr); |
470 | return ret; | |
471 | } | |
472 | ||
10078321 | 473 | static ssize_t lbs_rdmac_write(struct file *file, |
876c9d3a MT |
474 | const char __user *userbuf, |
475 | size_t count, loff_t *ppos) | |
476 | { | |
69f9032d | 477 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
478 | ssize_t res, buf_size; |
479 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
480 | char *buf = (char *)addr; | |
ad43f8bf KD |
481 | if (!buf) |
482 | return -ENOMEM; | |
876c9d3a MT |
483 | |
484 | buf_size = min(count, len - 1); | |
485 | if (copy_from_user(buf, userbuf, buf_size)) { | |
486 | res = -EFAULT; | |
487 | goto out_unlock; | |
488 | } | |
489 | priv->mac_offset = simple_strtoul((char *)buf, NULL, 16); | |
490 | res = count; | |
491 | out_unlock: | |
492 | free_page(addr); | |
493 | return res; | |
494 | } | |
495 | ||
10078321 | 496 | static ssize_t lbs_wrmac_write(struct file *file, |
876c9d3a MT |
497 | const char __user *userbuf, |
498 | size_t count, loff_t *ppos) | |
499 | { | |
500 | ||
69f9032d | 501 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
502 | ssize_t res, buf_size; |
503 | u32 offset, value; | |
876c9d3a MT |
504 | unsigned long addr = get_zeroed_page(GFP_KERNEL); |
505 | char *buf = (char *)addr; | |
ad43f8bf KD |
506 | if (!buf) |
507 | return -ENOMEM; | |
876c9d3a MT |
508 | |
509 | buf_size = min(count, len - 1); | |
510 | if (copy_from_user(buf, userbuf, buf_size)) { | |
511 | res = -EFAULT; | |
512 | goto out_unlock; | |
513 | } | |
514 | res = sscanf(buf, "%x %x", &offset, &value); | |
515 | if (res != 2) { | |
516 | res = -EFAULT; | |
517 | goto out_unlock; | |
518 | } | |
519 | ||
4c7c6e00 | 520 | res = lbs_set_reg(priv, CMD_MAC_REG_ACCESS, offset, value); |
876c9d3a MT |
521 | mdelay(10); |
522 | ||
c0bbd576 AK |
523 | if (!res) |
524 | res = count; | |
876c9d3a MT |
525 | out_unlock: |
526 | free_page(addr); | |
527 | return res; | |
528 | } | |
529 | ||
10078321 | 530 | static ssize_t lbs_rdbbp_read(struct file *file, char __user *userbuf, |
876c9d3a MT |
531 | size_t count, loff_t *ppos) |
532 | { | |
69f9032d | 533 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
534 | ssize_t pos = 0; |
535 | int ret; | |
536 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
537 | char *buf = (char *)addr; | |
4c7c6e00 DW |
538 | u32 val; |
539 | ||
ad43f8bf KD |
540 | if (!buf) |
541 | return -ENOMEM; | |
876c9d3a | 542 | |
4c7c6e00 | 543 | ret = lbs_get_reg(priv, CMD_BBP_REG_ACCESS, priv->bbp_offset, &val); |
876c9d3a | 544 | mdelay(10); |
c0bbd576 | 545 | if (!ret) { |
4c7c6e00 DW |
546 | pos = snprintf(buf, len, "BBP[0x%x] = 0x%08x\n", |
547 | priv->bbp_offset, val); | |
c0bbd576 AK |
548 | ret = simple_read_from_buffer(userbuf, count, ppos, buf, pos); |
549 | } | |
876c9d3a MT |
550 | free_page(addr); |
551 | ||
552 | return ret; | |
553 | } | |
554 | ||
10078321 | 555 | static ssize_t lbs_rdbbp_write(struct file *file, |
876c9d3a MT |
556 | const char __user *userbuf, |
557 | size_t count, loff_t *ppos) | |
558 | { | |
69f9032d | 559 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
560 | ssize_t res, buf_size; |
561 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
562 | char *buf = (char *)addr; | |
ad43f8bf KD |
563 | if (!buf) |
564 | return -ENOMEM; | |
876c9d3a MT |
565 | |
566 | buf_size = min(count, len - 1); | |
567 | if (copy_from_user(buf, userbuf, buf_size)) { | |
568 | res = -EFAULT; | |
569 | goto out_unlock; | |
570 | } | |
571 | priv->bbp_offset = simple_strtoul((char *)buf, NULL, 16); | |
572 | res = count; | |
573 | out_unlock: | |
574 | free_page(addr); | |
575 | return res; | |
576 | } | |
577 | ||
10078321 | 578 | static ssize_t lbs_wrbbp_write(struct file *file, |
876c9d3a MT |
579 | const char __user *userbuf, |
580 | size_t count, loff_t *ppos) | |
581 | { | |
582 | ||
69f9032d | 583 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
584 | ssize_t res, buf_size; |
585 | u32 offset, value; | |
876c9d3a MT |
586 | unsigned long addr = get_zeroed_page(GFP_KERNEL); |
587 | char *buf = (char *)addr; | |
ad43f8bf KD |
588 | if (!buf) |
589 | return -ENOMEM; | |
876c9d3a MT |
590 | |
591 | buf_size = min(count, len - 1); | |
592 | if (copy_from_user(buf, userbuf, buf_size)) { | |
593 | res = -EFAULT; | |
594 | goto out_unlock; | |
595 | } | |
596 | res = sscanf(buf, "%x %x", &offset, &value); | |
597 | if (res != 2) { | |
598 | res = -EFAULT; | |
599 | goto out_unlock; | |
600 | } | |
601 | ||
4c7c6e00 | 602 | res = lbs_set_reg(priv, CMD_BBP_REG_ACCESS, offset, value); |
876c9d3a MT |
603 | mdelay(10); |
604 | ||
c0bbd576 AK |
605 | if (!res) |
606 | res = count; | |
876c9d3a MT |
607 | out_unlock: |
608 | free_page(addr); | |
609 | return res; | |
610 | } | |
611 | ||
10078321 | 612 | static ssize_t lbs_rdrf_read(struct file *file, char __user *userbuf, |
876c9d3a MT |
613 | size_t count, loff_t *ppos) |
614 | { | |
69f9032d | 615 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
616 | ssize_t pos = 0; |
617 | int ret; | |
618 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
619 | char *buf = (char *)addr; | |
4c7c6e00 DW |
620 | u32 val; |
621 | ||
ad43f8bf KD |
622 | if (!buf) |
623 | return -ENOMEM; | |
876c9d3a | 624 | |
4c7c6e00 | 625 | ret = lbs_get_reg(priv, CMD_RF_REG_ACCESS, priv->rf_offset, &val); |
876c9d3a | 626 | mdelay(10); |
c0bbd576 | 627 | if (!ret) { |
4c7c6e00 DW |
628 | pos = snprintf(buf, len, "RF[0x%x] = 0x%08x\n", |
629 | priv->rf_offset, val); | |
c0bbd576 AK |
630 | ret = simple_read_from_buffer(userbuf, count, ppos, buf, pos); |
631 | } | |
876c9d3a MT |
632 | free_page(addr); |
633 | ||
634 | return ret; | |
635 | } | |
636 | ||
10078321 | 637 | static ssize_t lbs_rdrf_write(struct file *file, |
876c9d3a MT |
638 | const char __user *userbuf, |
639 | size_t count, loff_t *ppos) | |
640 | { | |
69f9032d | 641 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
642 | ssize_t res, buf_size; |
643 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
644 | char *buf = (char *)addr; | |
ad43f8bf KD |
645 | if (!buf) |
646 | return -ENOMEM; | |
876c9d3a MT |
647 | |
648 | buf_size = min(count, len - 1); | |
649 | if (copy_from_user(buf, userbuf, buf_size)) { | |
650 | res = -EFAULT; | |
651 | goto out_unlock; | |
652 | } | |
4101dec9 | 653 | priv->rf_offset = simple_strtoul(buf, NULL, 16); |
876c9d3a MT |
654 | res = count; |
655 | out_unlock: | |
656 | free_page(addr); | |
657 | return res; | |
658 | } | |
659 | ||
10078321 | 660 | static ssize_t lbs_wrrf_write(struct file *file, |
876c9d3a MT |
661 | const char __user *userbuf, |
662 | size_t count, loff_t *ppos) | |
663 | { | |
664 | ||
69f9032d | 665 | struct lbs_private *priv = file->private_data; |
876c9d3a MT |
666 | ssize_t res, buf_size; |
667 | u32 offset, value; | |
876c9d3a MT |
668 | unsigned long addr = get_zeroed_page(GFP_KERNEL); |
669 | char *buf = (char *)addr; | |
ad43f8bf KD |
670 | if (!buf) |
671 | return -ENOMEM; | |
876c9d3a MT |
672 | |
673 | buf_size = min(count, len - 1); | |
674 | if (copy_from_user(buf, userbuf, buf_size)) { | |
675 | res = -EFAULT; | |
676 | goto out_unlock; | |
677 | } | |
678 | res = sscanf(buf, "%x %x", &offset, &value); | |
679 | if (res != 2) { | |
680 | res = -EFAULT; | |
681 | goto out_unlock; | |
682 | } | |
683 | ||
4c7c6e00 | 684 | res = lbs_set_reg(priv, CMD_RF_REG_ACCESS, offset, value); |
876c9d3a MT |
685 | mdelay(10); |
686 | ||
c0bbd576 AK |
687 | if (!res) |
688 | res = count; | |
876c9d3a MT |
689 | out_unlock: |
690 | free_page(addr); | |
691 | return res; | |
692 | } | |
693 | ||
694 | #define FOPS(fread, fwrite) { \ | |
695 | .owner = THIS_MODULE, \ | |
696 | .open = open_file_generic, \ | |
697 | .read = (fread), \ | |
698 | .write = (fwrite), \ | |
2b18ab36 | 699 | .llseek = generic_file_llseek, \ |
876c9d3a MT |
700 | } |
701 | ||
10078321 | 702 | struct lbs_debugfs_files { |
4101dec9 | 703 | const char *name; |
876c9d3a MT |
704 | int perm; |
705 | struct file_operations fops; | |
706 | }; | |
707 | ||
4101dec9 | 708 | static const struct lbs_debugfs_files debugfs_files[] = { |
10078321 | 709 | { "info", 0444, FOPS(lbs_dev_info, write_file_dummy), }, |
10078321 HS |
710 | { "sleepparams", 0644, FOPS(lbs_sleepparams_read, |
711 | lbs_sleepparams_write), }, | |
1311843c AK |
712 | { "hostsleep", 0644, FOPS(lbs_host_sleep_read, |
713 | lbs_host_sleep_write), }, | |
876c9d3a MT |
714 | }; |
715 | ||
4101dec9 | 716 | static const struct lbs_debugfs_files debugfs_events_files[] = { |
10078321 HS |
717 | {"low_rssi", 0644, FOPS(lbs_lowrssi_read, |
718 | lbs_lowrssi_write), }, | |
719 | {"low_snr", 0644, FOPS(lbs_lowsnr_read, | |
720 | lbs_lowsnr_write), }, | |
721 | {"failure_count", 0644, FOPS(lbs_failcount_read, | |
722 | lbs_failcount_write), }, | |
723 | {"beacon_missed", 0644, FOPS(lbs_bcnmiss_read, | |
724 | lbs_bcnmiss_write), }, | |
725 | {"high_rssi", 0644, FOPS(lbs_highrssi_read, | |
726 | lbs_highrssi_write), }, | |
727 | {"high_snr", 0644, FOPS(lbs_highsnr_read, | |
728 | lbs_highsnr_write), }, | |
876c9d3a MT |
729 | }; |
730 | ||
4101dec9 | 731 | static const struct lbs_debugfs_files debugfs_regs_files[] = { |
10078321 HS |
732 | {"rdmac", 0644, FOPS(lbs_rdmac_read, lbs_rdmac_write), }, |
733 | {"wrmac", 0600, FOPS(NULL, lbs_wrmac_write), }, | |
734 | {"rdbbp", 0644, FOPS(lbs_rdbbp_read, lbs_rdbbp_write), }, | |
735 | {"wrbbp", 0600, FOPS(NULL, lbs_wrbbp_write), }, | |
736 | {"rdrf", 0644, FOPS(lbs_rdrf_read, lbs_rdrf_write), }, | |
737 | {"wrrf", 0600, FOPS(NULL, lbs_wrrf_write), }, | |
876c9d3a MT |
738 | }; |
739 | ||
10078321 | 740 | void lbs_debugfs_init(void) |
876c9d3a | 741 | { |
10078321 HS |
742 | if (!lbs_dir) |
743 | lbs_dir = debugfs_create_dir("lbs_wireless", NULL); | |
876c9d3a MT |
744 | } |
745 | ||
10078321 | 746 | void lbs_debugfs_remove(void) |
876c9d3a | 747 | { |
10078321 HS |
748 | if (lbs_dir) |
749 | debugfs_remove(lbs_dir); | |
876c9d3a MT |
750 | } |
751 | ||
69f9032d | 752 | void lbs_debugfs_init_one(struct lbs_private *priv, struct net_device *dev) |
876c9d3a MT |
753 | { |
754 | int i; | |
4101dec9 | 755 | const struct lbs_debugfs_files *files; |
10078321 | 756 | if (!lbs_dir) |
876c9d3a MT |
757 | goto exit; |
758 | ||
10078321 | 759 | priv->debugfs_dir = debugfs_create_dir(dev->name, lbs_dir); |
876c9d3a MT |
760 | if (!priv->debugfs_dir) |
761 | goto exit; | |
762 | ||
763 | for (i=0; i<ARRAY_SIZE(debugfs_files); i++) { | |
764 | files = &debugfs_files[i]; | |
765 | priv->debugfs_files[i] = debugfs_create_file(files->name, | |
766 | files->perm, | |
767 | priv->debugfs_dir, | |
768 | priv, | |
769 | &files->fops); | |
770 | } | |
771 | ||
772 | priv->events_dir = debugfs_create_dir("subscribed_events", priv->debugfs_dir); | |
773 | if (!priv->events_dir) | |
774 | goto exit; | |
775 | ||
776 | for (i=0; i<ARRAY_SIZE(debugfs_events_files); i++) { | |
777 | files = &debugfs_events_files[i]; | |
778 | priv->debugfs_events_files[i] = debugfs_create_file(files->name, | |
779 | files->perm, | |
780 | priv->events_dir, | |
781 | priv, | |
782 | &files->fops); | |
783 | } | |
784 | ||
785 | priv->regs_dir = debugfs_create_dir("registers", priv->debugfs_dir); | |
786 | if (!priv->regs_dir) | |
787 | goto exit; | |
788 | ||
789 | for (i=0; i<ARRAY_SIZE(debugfs_regs_files); i++) { | |
790 | files = &debugfs_regs_files[i]; | |
791 | priv->debugfs_regs_files[i] = debugfs_create_file(files->name, | |
792 | files->perm, | |
793 | priv->regs_dir, | |
794 | priv, | |
795 | &files->fops); | |
796 | } | |
797 | ||
798 | #ifdef PROC_DEBUG | |
e98a88dd | 799 | lbs_debug_init(priv); |
876c9d3a MT |
800 | #endif |
801 | exit: | |
802 | return; | |
803 | } | |
804 | ||
69f9032d | 805 | void lbs_debugfs_remove_one(struct lbs_private *priv) |
876c9d3a MT |
806 | { |
807 | int i; | |
808 | ||
809 | for(i=0; i<ARRAY_SIZE(debugfs_regs_files); i++) | |
810 | debugfs_remove(priv->debugfs_regs_files[i]); | |
811 | ||
812 | debugfs_remove(priv->regs_dir); | |
813 | ||
0b7db956 | 814 | for(i=0; i<ARRAY_SIZE(debugfs_events_files); i++) |
876c9d3a MT |
815 | debugfs_remove(priv->debugfs_events_files[i]); |
816 | ||
817 | debugfs_remove(priv->events_dir); | |
818 | #ifdef PROC_DEBUG | |
819 | debugfs_remove(priv->debugfs_debug); | |
820 | #endif | |
821 | for(i=0; i<ARRAY_SIZE(debugfs_files); i++) | |
822 | debugfs_remove(priv->debugfs_files[i]); | |
0b7db956 | 823 | debugfs_remove(priv->debugfs_dir); |
876c9d3a MT |
824 | } |
825 | ||
46868202 HS |
826 | |
827 | ||
876c9d3a MT |
828 | /* debug entry */ |
829 | ||
46868202 HS |
830 | #ifdef PROC_DEBUG |
831 | ||
aa21c004 DW |
832 | #define item_size(n) (FIELD_SIZEOF(struct lbs_private, n)) |
833 | #define item_addr(n) (offsetof(struct lbs_private, n)) | |
876c9d3a | 834 | |
46868202 | 835 | |
876c9d3a MT |
836 | struct debug_data { |
837 | char name[32]; | |
838 | u32 size; | |
4269e2ad | 839 | size_t addr; |
876c9d3a MT |
840 | }; |
841 | ||
aa21c004 | 842 | /* To debug any member of struct lbs_private, simply add one line here. |
876c9d3a MT |
843 | */ |
844 | static struct debug_data items[] = { | |
876c9d3a MT |
845 | {"psmode", item_size(psmode), item_addr(psmode)}, |
846 | {"psstate", item_size(psstate), item_addr(psstate)}, | |
847 | }; | |
848 | ||
d2f11e09 | 849 | static int num_of_items = ARRAY_SIZE(items); |
876c9d3a MT |
850 | |
851 | /** | |
852 | * @brief proc read function | |
853 | * | |
854 | * @param page pointer to buffer | |
855 | * @param s read data starting position | |
856 | * @param off offset | |
857 | * @param cnt counter | |
858 | * @param eof end of file flag | |
859 | * @param data data to output | |
860 | * @return number of output data | |
861 | */ | |
10078321 | 862 | static ssize_t lbs_debugfs_read(struct file *file, char __user *userbuf, |
876c9d3a MT |
863 | size_t count, loff_t *ppos) |
864 | { | |
865 | int val = 0; | |
866 | size_t pos = 0; | |
867 | ssize_t res; | |
868 | char *p; | |
869 | int i; | |
870 | struct debug_data *d; | |
871 | unsigned long addr = get_zeroed_page(GFP_KERNEL); | |
872 | char *buf = (char *)addr; | |
ad43f8bf KD |
873 | if (!buf) |
874 | return -ENOMEM; | |
876c9d3a MT |
875 | |
876 | p = buf; | |
877 | ||
57674308 | 878 | d = file->private_data; |
876c9d3a MT |
879 | |
880 | for (i = 0; i < num_of_items; i++) { | |
881 | if (d[i].size == 1) | |
882 | val = *((u8 *) d[i].addr); | |
883 | else if (d[i].size == 2) | |
884 | val = *((u16 *) d[i].addr); | |
885 | else if (d[i].size == 4) | |
886 | val = *((u32 *) d[i].addr); | |
4269e2ad DW |
887 | else if (d[i].size == 8) |
888 | val = *((u64 *) d[i].addr); | |
876c9d3a MT |
889 | |
890 | pos += sprintf(p + pos, "%s=%d\n", d[i].name, val); | |
891 | } | |
892 | ||
893 | res = simple_read_from_buffer(userbuf, count, ppos, p, pos); | |
894 | ||
895 | free_page(addr); | |
896 | return res; | |
897 | } | |
898 | ||
899 | /** | |
900 | * @brief proc write function | |
901 | * | |
902 | * @param f file pointer | |
903 | * @param buf pointer to data buffer | |
904 | * @param cnt data number to write | |
905 | * @param data data to write | |
906 | * @return number of data | |
907 | */ | |
10078321 | 908 | static ssize_t lbs_debugfs_write(struct file *f, const char __user *buf, |
876c9d3a MT |
909 | size_t cnt, loff_t *ppos) |
910 | { | |
911 | int r, i; | |
912 | char *pdata; | |
913 | char *p; | |
914 | char *p0; | |
915 | char *p1; | |
916 | char *p2; | |
57674308 | 917 | struct debug_data *d = f->private_data; |
876c9d3a | 918 | |
655b4d16 | 919 | pdata = kmalloc(cnt, GFP_KERNEL); |
876c9d3a MT |
920 | if (pdata == NULL) |
921 | return 0; | |
922 | ||
923 | if (copy_from_user(pdata, buf, cnt)) { | |
9012b28a | 924 | lbs_deb_debugfs("Copy from user failed\n"); |
876c9d3a MT |
925 | kfree(pdata); |
926 | return 0; | |
927 | } | |
928 | ||
929 | p0 = pdata; | |
930 | for (i = 0; i < num_of_items; i++) { | |
931 | do { | |
932 | p = strstr(p0, d[i].name); | |
933 | if (p == NULL) | |
934 | break; | |
935 | p1 = strchr(p, '\n'); | |
936 | if (p1 == NULL) | |
937 | break; | |
938 | p0 = p1++; | |
939 | p2 = strchr(p, '='); | |
940 | if (!p2) | |
941 | break; | |
942 | p2++; | |
d2f11e09 | 943 | r = simple_strtoul(p2, NULL, 0); |
876c9d3a MT |
944 | if (d[i].size == 1) |
945 | *((u8 *) d[i].addr) = (u8) r; | |
946 | else if (d[i].size == 2) | |
947 | *((u16 *) d[i].addr) = (u16) r; | |
948 | else if (d[i].size == 4) | |
949 | *((u32 *) d[i].addr) = (u32) r; | |
4269e2ad DW |
950 | else if (d[i].size == 8) |
951 | *((u64 *) d[i].addr) = (u64) r; | |
876c9d3a MT |
952 | break; |
953 | } while (1); | |
954 | } | |
955 | kfree(pdata); | |
956 | ||
4269e2ad | 957 | return (ssize_t)cnt; |
876c9d3a MT |
958 | } |
959 | ||
4101dec9 | 960 | static const struct file_operations lbs_debug_fops = { |
876c9d3a MT |
961 | .owner = THIS_MODULE, |
962 | .open = open_file_generic, | |
10078321 HS |
963 | .write = lbs_debugfs_write, |
964 | .read = lbs_debugfs_read, | |
6038f373 | 965 | .llseek = default_llseek, |
876c9d3a MT |
966 | }; |
967 | ||
968 | /** | |
969 | * @brief create debug proc file | |
970 | * | |
69f9032d | 971 | * @param priv pointer struct lbs_private |
876c9d3a MT |
972 | * @param dev pointer net_device |
973 | * @return N/A | |
974 | */ | |
e98a88dd | 975 | static void lbs_debug_init(struct lbs_private *priv) |
876c9d3a MT |
976 | { |
977 | int i; | |
978 | ||
979 | if (!priv->debugfs_dir) | |
980 | return; | |
981 | ||
982 | for (i = 0; i < num_of_items; i++) | |
aa21c004 | 983 | items[i].addr += (size_t) priv; |
876c9d3a MT |
984 | |
985 | priv->debugfs_debug = debugfs_create_file("debug", 0644, | |
986 | priv->debugfs_dir, &items[0], | |
10078321 | 987 | &lbs_debug_fops); |
876c9d3a | 988 | } |
46868202 | 989 | #endif |