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