Commit | Line | Data |
---|---|---|
a910e4a9 SP |
1 | /* |
2 | * mac80211 glue code for mac80211 ST-Ericsson CW1200 drivers | |
3 | * DebugFS code | |
4 | * | |
5 | * Copyright (c) 2010, ST-Ericsson | |
6 | * Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no> | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License version 2 as | |
10 | * published by the Free Software Foundation. | |
11 | */ | |
12 | ||
13 | #include <linux/module.h> | |
14 | #include <linux/debugfs.h> | |
15 | #include <linux/seq_file.h> | |
16 | #include "cw1200.h" | |
17 | #include "debug.h" | |
18 | #include "fwio.h" | |
19 | ||
20 | /* join_status */ | |
21 | static const char * const cw1200_debug_join_status[] = { | |
22 | "passive", | |
23 | "monitor", | |
24 | "station (joining)", | |
25 | "station (not authenticated yet)", | |
26 | "station", | |
27 | "adhoc", | |
28 | "access point", | |
29 | }; | |
30 | ||
31 | /* WSM_JOIN_PREAMBLE_... */ | |
32 | static const char * const cw1200_debug_preamble[] = { | |
33 | "long", | |
34 | "short", | |
35 | "long on 1 and 2 Mbps", | |
36 | }; | |
37 | ||
38 | ||
39 | static const char * const cw1200_debug_link_id[] = { | |
40 | "OFF", | |
41 | "REQ", | |
42 | "SOFT", | |
43 | "HARD", | |
44 | }; | |
45 | ||
46 | static const char *cw1200_debug_mode(int mode) | |
47 | { | |
48 | switch (mode) { | |
49 | case NL80211_IFTYPE_UNSPECIFIED: | |
50 | return "unspecified"; | |
51 | case NL80211_IFTYPE_MONITOR: | |
52 | return "monitor"; | |
53 | case NL80211_IFTYPE_STATION: | |
54 | return "station"; | |
55 | case NL80211_IFTYPE_ADHOC: | |
56 | return "adhoc"; | |
57 | case NL80211_IFTYPE_MESH_POINT: | |
58 | return "mesh point"; | |
59 | case NL80211_IFTYPE_AP: | |
60 | return "access point"; | |
61 | case NL80211_IFTYPE_P2P_CLIENT: | |
62 | return "p2p client"; | |
63 | case NL80211_IFTYPE_P2P_GO: | |
64 | return "p2p go"; | |
65 | default: | |
66 | return "unsupported"; | |
67 | } | |
68 | } | |
69 | ||
70 | static void cw1200_queue_status_show(struct seq_file *seq, | |
71 | struct cw1200_queue *q) | |
72 | { | |
73 | int i; | |
74 | seq_printf(seq, "Queue %d:\n", q->queue_id); | |
75 | seq_printf(seq, " capacity: %zu\n", q->capacity); | |
76 | seq_printf(seq, " queued: %zu\n", q->num_queued); | |
77 | seq_printf(seq, " pending: %zu\n", q->num_pending); | |
78 | seq_printf(seq, " sent: %zu\n", q->num_sent); | |
79 | seq_printf(seq, " locked: %s\n", q->tx_locked_cnt ? "yes" : "no"); | |
80 | seq_printf(seq, " overfull: %s\n", q->overfull ? "yes" : "no"); | |
81 | seq_puts(seq, " link map: 0-> "); | |
82 | for (i = 0; i < q->stats->map_capacity; ++i) | |
83 | seq_printf(seq, "%.2d ", q->link_map_cache[i]); | |
84 | seq_printf(seq, "<-%zu\n", q->stats->map_capacity); | |
85 | } | |
86 | ||
87 | static void cw1200_debug_print_map(struct seq_file *seq, | |
88 | struct cw1200_common *priv, | |
89 | const char *label, | |
90 | u32 map) | |
91 | { | |
92 | int i; | |
93 | seq_printf(seq, "%s0-> ", label); | |
94 | for (i = 0; i < priv->tx_queue_stats.map_capacity; ++i) | |
95 | seq_printf(seq, "%s ", (map & BIT(i)) ? "**" : ".."); | |
96 | seq_printf(seq, "<-%zu\n", priv->tx_queue_stats.map_capacity - 1); | |
97 | } | |
98 | ||
99 | static int cw1200_status_show(struct seq_file *seq, void *v) | |
100 | { | |
101 | int i; | |
102 | struct list_head *item; | |
103 | struct cw1200_common *priv = seq->private; | |
104 | struct cw1200_debug_priv *d = priv->debug; | |
105 | ||
106 | seq_puts(seq, "CW1200 Wireless LAN driver status\n"); | |
107 | seq_printf(seq, "Hardware: %d.%d\n", | |
108 | priv->wsm_caps.hw_id, | |
109 | priv->wsm_caps.hw_subid); | |
110 | seq_printf(seq, "Firmware: %s %d.%d\n", | |
111 | cw1200_fw_types[priv->wsm_caps.fw_type], | |
112 | priv->wsm_caps.fw_ver, | |
113 | priv->wsm_caps.fw_build); | |
114 | seq_printf(seq, "FW API: %d\n", | |
115 | priv->wsm_caps.fw_api); | |
116 | seq_printf(seq, "FW caps: 0x%.4X\n", | |
117 | priv->wsm_caps.fw_cap); | |
118 | seq_printf(seq, "FW label: '%s'\n", | |
119 | priv->wsm_caps.fw_label); | |
120 | seq_printf(seq, "Mode: %s%s\n", | |
121 | cw1200_debug_mode(priv->mode), | |
122 | priv->listening ? " (listening)" : ""); | |
123 | seq_printf(seq, "Join state: %s\n", | |
124 | cw1200_debug_join_status[priv->join_status]); | |
125 | if (priv->channel) | |
126 | seq_printf(seq, "Channel: %d%s\n", | |
127 | priv->channel->hw_value, | |
128 | priv->channel_switch_in_progress ? | |
129 | " (switching)" : ""); | |
130 | if (priv->rx_filter.promiscuous) | |
131 | seq_puts(seq, "Filter: promisc\n"); | |
132 | else if (priv->rx_filter.fcs) | |
133 | seq_puts(seq, "Filter: fcs\n"); | |
134 | if (priv->rx_filter.bssid) | |
135 | seq_puts(seq, "Filter: bssid\n"); | |
136 | if (!priv->disable_beacon_filter) | |
137 | seq_puts(seq, "Filter: beacons\n"); | |
138 | ||
139 | if (priv->enable_beacon || | |
140 | priv->mode == NL80211_IFTYPE_AP || | |
141 | priv->mode == NL80211_IFTYPE_ADHOC || | |
142 | priv->mode == NL80211_IFTYPE_MESH_POINT || | |
143 | priv->mode == NL80211_IFTYPE_P2P_GO) | |
144 | seq_printf(seq, "Beaconing: %s\n", | |
145 | priv->enable_beacon ? | |
146 | "enabled" : "disabled"); | |
147 | ||
148 | for (i = 0; i < 4; ++i) | |
149 | seq_printf(seq, "EDCA(%d): %d, %d, %d, %d, %d\n", i, | |
150 | priv->edca.params[i].cwmin, | |
151 | priv->edca.params[i].cwmax, | |
152 | priv->edca.params[i].aifns, | |
153 | priv->edca.params[i].txop_limit, | |
154 | priv->edca.params[i].max_rx_lifetime); | |
155 | ||
156 | if (priv->join_status == CW1200_JOIN_STATUS_STA) { | |
157 | static const char *pm_mode = "unknown"; | |
158 | switch (priv->powersave_mode.mode) { | |
159 | case WSM_PSM_ACTIVE: | |
160 | pm_mode = "off"; | |
161 | break; | |
162 | case WSM_PSM_PS: | |
163 | pm_mode = "on"; | |
164 | break; | |
165 | case WSM_PSM_FAST_PS: | |
166 | pm_mode = "dynamic"; | |
167 | break; | |
168 | } | |
169 | seq_printf(seq, "Preamble: %s\n", | |
170 | cw1200_debug_preamble[priv->association_mode.preamble]); | |
171 | seq_printf(seq, "AMPDU spcn: %d\n", | |
172 | priv->association_mode.mpdu_start_spacing); | |
173 | seq_printf(seq, "Basic rate: 0x%.8X\n", | |
174 | le32_to_cpu(priv->association_mode.basic_rate_set)); | |
175 | seq_printf(seq, "Bss lost: %d beacons\n", | |
176 | priv->bss_params.beacon_lost_count); | |
177 | seq_printf(seq, "AID: %d\n", | |
178 | priv->bss_params.aid); | |
179 | seq_printf(seq, "Rates: 0x%.8X\n", | |
180 | priv->bss_params.operational_rate_set); | |
181 | seq_printf(seq, "Powersave: %s\n", pm_mode); | |
182 | } | |
183 | seq_printf(seq, "HT: %s\n", | |
184 | cw1200_is_ht(&priv->ht_info) ? "on" : "off"); | |
185 | if (cw1200_is_ht(&priv->ht_info)) { | |
186 | seq_printf(seq, "Greenfield: %s\n", | |
187 | cw1200_ht_greenfield(&priv->ht_info) ? "yes" : "no"); | |
188 | seq_printf(seq, "AMPDU dens: %d\n", | |
189 | cw1200_ht_ampdu_density(&priv->ht_info)); | |
190 | } | |
191 | seq_printf(seq, "RSSI thold: %d\n", | |
192 | priv->cqm_rssi_thold); | |
193 | seq_printf(seq, "RSSI hyst: %d\n", | |
194 | priv->cqm_rssi_hyst); | |
195 | seq_printf(seq, "Long retr: %d\n", | |
196 | priv->long_frame_max_tx_count); | |
197 | seq_printf(seq, "Short retr: %d\n", | |
198 | priv->short_frame_max_tx_count); | |
199 | spin_lock_bh(&priv->tx_policy_cache.lock); | |
200 | i = 0; | |
201 | list_for_each(item, &priv->tx_policy_cache.used) | |
202 | ++i; | |
203 | spin_unlock_bh(&priv->tx_policy_cache.lock); | |
204 | seq_printf(seq, "RC in use: %d\n", i); | |
205 | ||
206 | seq_puts(seq, "\n"); | |
207 | for (i = 0; i < 4; ++i) { | |
208 | cw1200_queue_status_show(seq, &priv->tx_queue[i]); | |
209 | seq_puts(seq, "\n"); | |
210 | } | |
211 | ||
212 | cw1200_debug_print_map(seq, priv, "Link map: ", | |
213 | priv->link_id_map); | |
214 | cw1200_debug_print_map(seq, priv, "Asleep map: ", | |
215 | priv->sta_asleep_mask); | |
216 | cw1200_debug_print_map(seq, priv, "PSPOLL map: ", | |
217 | priv->pspoll_mask); | |
218 | ||
219 | seq_puts(seq, "\n"); | |
220 | ||
221 | for (i = 0; i < CW1200_MAX_STA_IN_AP_MODE; ++i) { | |
222 | if (priv->link_id_db[i].status) { | |
223 | seq_printf(seq, "Link %d: %s, %pM\n", | |
224 | i + 1, | |
225 | cw1200_debug_link_id[priv->link_id_db[i].status], | |
226 | priv->link_id_db[i].mac); | |
227 | } | |
228 | } | |
229 | ||
230 | seq_puts(seq, "\n"); | |
231 | ||
232 | seq_printf(seq, "BH status: %s\n", | |
233 | atomic_read(&priv->bh_term) ? "terminated" : "alive"); | |
234 | seq_printf(seq, "Pending RX: %d\n", | |
235 | atomic_read(&priv->bh_rx)); | |
236 | seq_printf(seq, "Pending TX: %d\n", | |
237 | atomic_read(&priv->bh_tx)); | |
238 | if (priv->bh_error) | |
239 | seq_printf(seq, "BH errcode: %d\n", | |
240 | priv->bh_error); | |
241 | seq_printf(seq, "TX bufs: %d x %d bytes\n", | |
242 | priv->wsm_caps.input_buffers, | |
243 | priv->wsm_caps.input_buffer_size); | |
244 | seq_printf(seq, "Used bufs: %d\n", | |
245 | priv->hw_bufs_used); | |
246 | seq_printf(seq, "Powermgmt: %s\n", | |
247 | priv->powersave_enabled ? "on" : "off"); | |
248 | seq_printf(seq, "Device: %s\n", | |
249 | priv->device_can_sleep ? "asleep" : "awake"); | |
250 | ||
251 | spin_lock(&priv->wsm_cmd.lock); | |
252 | seq_printf(seq, "WSM status: %s\n", | |
253 | priv->wsm_cmd.done ? "idle" : "active"); | |
254 | seq_printf(seq, "WSM cmd: 0x%.4X (%td bytes)\n", | |
255 | priv->wsm_cmd.cmd, priv->wsm_cmd.len); | |
256 | seq_printf(seq, "WSM retval: %d\n", | |
257 | priv->wsm_cmd.ret); | |
258 | spin_unlock(&priv->wsm_cmd.lock); | |
259 | ||
260 | seq_printf(seq, "Datapath: %s\n", | |
261 | atomic_read(&priv->tx_lock) ? "locked" : "unlocked"); | |
262 | if (atomic_read(&priv->tx_lock)) | |
263 | seq_printf(seq, "TXlock cnt: %d\n", | |
264 | atomic_read(&priv->tx_lock)); | |
265 | ||
266 | seq_printf(seq, "TXed: %d\n", | |
267 | d->tx); | |
268 | seq_printf(seq, "AGG TXed: %d\n", | |
269 | d->tx_agg); | |
270 | seq_printf(seq, "MULTI TXed: %d (%d)\n", | |
271 | d->tx_multi, d->tx_multi_frames); | |
272 | seq_printf(seq, "RXed: %d\n", | |
273 | d->rx); | |
274 | seq_printf(seq, "AGG RXed: %d\n", | |
275 | d->rx_agg); | |
276 | seq_printf(seq, "TX miss: %d\n", | |
277 | d->tx_cache_miss); | |
278 | seq_printf(seq, "TX align: %d\n", | |
279 | d->tx_align); | |
280 | seq_printf(seq, "TX burst: %d\n", | |
281 | d->tx_burst); | |
282 | seq_printf(seq, "TX TTL: %d\n", | |
283 | d->tx_ttl); | |
284 | seq_printf(seq, "Scan: %s\n", | |
285 | atomic_read(&priv->scan.in_progress) ? "active" : "idle"); | |
286 | ||
287 | return 0; | |
288 | } | |
289 | ||
290 | static int cw1200_status_open(struct inode *inode, struct file *file) | |
291 | { | |
292 | return single_open(file, &cw1200_status_show, | |
293 | inode->i_private); | |
294 | } | |
295 | ||
296 | static const struct file_operations fops_status = { | |
297 | .open = cw1200_status_open, | |
298 | .read = seq_read, | |
299 | .llseek = seq_lseek, | |
300 | .release = single_release, | |
301 | .owner = THIS_MODULE, | |
302 | }; | |
303 | ||
304 | static int cw1200_counters_show(struct seq_file *seq, void *v) | |
305 | { | |
306 | int ret; | |
307 | struct cw1200_common *priv = seq->private; | |
308 | struct wsm_mib_counters_table counters; | |
309 | ||
310 | ret = wsm_get_counters_table(priv, &counters); | |
311 | if (ret) | |
312 | return ret; | |
313 | ||
314 | #define PUT_COUNTER(tab, name) \ | |
315 | seq_printf(seq, "%s:" tab "%d\n", #name, \ | |
316 | __le32_to_cpu(counters.name)) | |
317 | ||
318 | PUT_COUNTER("\t\t", plcp_errors); | |
319 | PUT_COUNTER("\t\t", fcs_errors); | |
320 | PUT_COUNTER("\t\t", tx_packets); | |
321 | PUT_COUNTER("\t\t", rx_packets); | |
322 | PUT_COUNTER("\t\t", rx_packet_errors); | |
323 | PUT_COUNTER("\t", rx_decryption_failures); | |
324 | PUT_COUNTER("\t\t", rx_mic_failures); | |
325 | PUT_COUNTER("\t", rx_no_key_failures); | |
326 | PUT_COUNTER("\t", tx_multicast_frames); | |
327 | PUT_COUNTER("\t", tx_frames_success); | |
328 | PUT_COUNTER("\t", tx_frame_failures); | |
329 | PUT_COUNTER("\t", tx_frames_retried); | |
330 | PUT_COUNTER("\t", tx_frames_multi_retried); | |
331 | PUT_COUNTER("\t", rx_frame_duplicates); | |
332 | PUT_COUNTER("\t\t", rts_success); | |
333 | PUT_COUNTER("\t\t", rts_failures); | |
334 | PUT_COUNTER("\t\t", ack_failures); | |
335 | PUT_COUNTER("\t", rx_multicast_frames); | |
336 | PUT_COUNTER("\t", rx_frames_success); | |
337 | PUT_COUNTER("\t", rx_cmac_icv_errors); | |
338 | PUT_COUNTER("\t\t", rx_cmac_replays); | |
339 | PUT_COUNTER("\t", rx_mgmt_ccmp_replays); | |
340 | ||
341 | #undef PUT_COUNTER | |
342 | ||
343 | return 0; | |
344 | } | |
345 | ||
346 | static int cw1200_counters_open(struct inode *inode, struct file *file) | |
347 | { | |
348 | return single_open(file, &cw1200_counters_show, | |
349 | inode->i_private); | |
350 | } | |
351 | ||
352 | static const struct file_operations fops_counters = { | |
353 | .open = cw1200_counters_open, | |
354 | .read = seq_read, | |
355 | .llseek = seq_lseek, | |
356 | .release = single_release, | |
357 | .owner = THIS_MODULE, | |
358 | }; | |
359 | ||
a910e4a9 SP |
360 | #ifdef CONFIG_CW1200_ETF |
361 | static int cw1200_etf_out_show(struct seq_file *seq, void *v) | |
362 | { | |
363 | struct cw1200_common *priv = seq->private; | |
364 | struct sk_buff *skb; | |
365 | u32 len = 0; | |
366 | ||
367 | skb = skb_dequeue(&priv->etf_q); | |
368 | ||
369 | if (skb) | |
370 | len = skb->len; | |
371 | ||
372 | seq_write(seq, &len, sizeof(len)); | |
373 | ||
374 | if (skb) { | |
375 | seq_write(seq, skb->data, len); | |
376 | kfree_skb(skb); | |
377 | } | |
378 | ||
379 | return 0; | |
380 | } | |
381 | ||
382 | static int cw1200_etf_out_open(struct inode *inode, struct file *file) | |
383 | { | |
384 | return single_open(file, &cw1200_etf_out_show, | |
385 | inode->i_private); | |
386 | } | |
387 | ||
388 | static const struct file_operations fops_etf_out = { | |
389 | .open = cw1200_etf_out_open, | |
390 | .read = seq_read, | |
391 | .llseek = seq_lseek, | |
392 | .release = single_release, | |
393 | .owner = THIS_MODULE, | |
394 | }; | |
395 | ||
396 | struct etf_req_msg; | |
397 | static int etf_request(struct cw1200_common *priv, | |
398 | struct etf_req_msg *msg, u32 len); | |
399 | ||
aa63e18e | 400 | #define MAX_RX_SIZE 2600 |
a910e4a9 SP |
401 | |
402 | struct etf_in_state { | |
403 | struct cw1200_common *priv; | |
aa63e18e SP |
404 | u16 total_len; |
405 | u16 written; | |
406 | u8 buf[MAX_RX_SIZE]; | |
a910e4a9 SP |
407 | }; |
408 | ||
409 | static int cw1200_etf_in_open(struct inode *inode, struct file *file) | |
410 | { | |
411 | struct etf_in_state *etf = kmalloc(sizeof(struct etf_in_state), | |
412 | GFP_KERNEL); | |
413 | ||
414 | if (!etf) | |
415 | return -ENOMEM; | |
416 | ||
417 | etf->written = 0; | |
418 | etf->total_len = 0; | |
419 | etf->priv = inode->i_private; | |
420 | ||
421 | file->private_data = etf; | |
422 | ||
423 | return 0; | |
424 | } | |
425 | ||
426 | static int cw1200_etf_in_release(struct inode *inode, struct file *file) | |
427 | { | |
428 | kfree(file->private_data); | |
429 | return 0; | |
430 | } | |
431 | ||
432 | static ssize_t cw1200_etf_in_write(struct file *file, | |
433 | const char __user *user_buf, size_t count, loff_t *ppos) | |
434 | { | |
435 | struct etf_in_state *etf = file->private_data; | |
436 | ||
437 | ssize_t written = 0; | |
438 | ||
439 | if (!etf->total_len) { | |
440 | if (count < sizeof(etf->total_len)) { | |
441 | pr_err("count < sizeof(total_len)\n"); | |
442 | return -EINVAL; | |
443 | } | |
444 | ||
445 | if (copy_from_user(&etf->total_len, user_buf, | |
446 | sizeof(etf->total_len))) { | |
447 | pr_err("copy_from_user (len) failed\n"); | |
448 | return -EFAULT; | |
449 | } | |
450 | ||
aa63e18e SP |
451 | if (etf->total_len > MAX_RX_SIZE) { |
452 | pr_err("requested length > MAX_RX_SIZE\n"); | |
453 | return -EINVAL; | |
454 | } | |
455 | ||
a910e4a9 SP |
456 | written += sizeof(etf->total_len); |
457 | count -= sizeof(etf->total_len); | |
458 | } | |
459 | ||
460 | if (!count) | |
461 | goto done; | |
462 | ||
aa63e18e SP |
463 | if (count > (etf->total_len - written)) { |
464 | pr_err("Tried to write > MAX_RX_SIZE\n"); | |
465 | return -EINVAL; | |
466 | } | |
467 | ||
a910e4a9 SP |
468 | if (copy_from_user(etf->buf + etf->written, user_buf + written, |
469 | count)) { | |
470 | pr_err("copy_from_user (payload %zu) failed\n", count); | |
471 | return -EFAULT; | |
472 | } | |
473 | ||
474 | written += count; | |
475 | etf->written += count; | |
476 | ||
477 | if (etf->written >= etf->total_len) { | |
478 | if (etf_request(etf->priv, (struct etf_req_msg *)etf->buf, | |
479 | etf->total_len)) { | |
480 | pr_err("etf_request failed\n"); | |
481 | return -EIO; | |
482 | } | |
483 | } | |
484 | ||
485 | done: | |
486 | return written; | |
487 | } | |
488 | ||
489 | static const struct file_operations fops_etf_in = { | |
490 | .open = cw1200_etf_in_open, | |
491 | .release = cw1200_etf_in_release, | |
492 | .write = cw1200_etf_in_write, | |
493 | .llseek = default_llseek, | |
494 | .owner = THIS_MODULE, | |
495 | }; | |
496 | #endif /* CONFIG_CW1200_ETF */ | |
497 | ||
498 | static ssize_t cw1200_wsm_dumps(struct file *file, | |
499 | const char __user *user_buf, size_t count, loff_t *ppos) | |
500 | { | |
501 | struct cw1200_common *priv = file->private_data; | |
502 | char buf[1]; | |
503 | ||
504 | if (!count) | |
505 | return -EINVAL; | |
506 | if (copy_from_user(buf, user_buf, 1)) | |
507 | return -EFAULT; | |
508 | ||
509 | if (buf[0] == '1') | |
510 | priv->wsm_enable_wsm_dumps = 1; | |
511 | else | |
512 | priv->wsm_enable_wsm_dumps = 0; | |
513 | ||
514 | return count; | |
515 | } | |
516 | ||
517 | static const struct file_operations fops_wsm_dumps = { | |
c0dc79d6 | 518 | .open = simple_open, |
a910e4a9 SP |
519 | .write = cw1200_wsm_dumps, |
520 | .llseek = default_llseek, | |
521 | }; | |
522 | ||
523 | int cw1200_debug_init(struct cw1200_common *priv) | |
524 | { | |
525 | int ret = -ENOMEM; | |
526 | struct cw1200_debug_priv *d = kzalloc(sizeof(struct cw1200_debug_priv), | |
527 | GFP_KERNEL); | |
528 | priv->debug = d; | |
529 | if (!d) | |
530 | return ret; | |
531 | ||
532 | d->debugfs_phy = debugfs_create_dir("cw1200", | |
533 | priv->hw->wiphy->debugfsdir); | |
534 | if (!d->debugfs_phy) | |
535 | goto err; | |
536 | ||
537 | if (!debugfs_create_file("status", S_IRUSR, d->debugfs_phy, | |
538 | priv, &fops_status)) | |
539 | goto err; | |
540 | ||
541 | if (!debugfs_create_file("counters", S_IRUSR, d->debugfs_phy, | |
542 | priv, &fops_counters)) | |
543 | goto err; | |
544 | ||
545 | #ifdef CONFIG_CW1200_ETF | |
546 | if (etf_mode) { | |
547 | skb_queue_head_init(&priv->etf_q); | |
548 | ||
549 | if (!debugfs_create_file("etf_out", S_IRUSR, d->debugfs_phy, | |
550 | priv, &fops_etf_out)) | |
551 | goto err; | |
552 | if (!debugfs_create_file("etf_in", S_IWUSR, d->debugfs_phy, | |
553 | priv, &fops_etf_in)) | |
554 | goto err; | |
555 | } | |
556 | #endif /* CONFIG_CW1200_ETF */ | |
557 | ||
558 | if (!debugfs_create_file("wsm_dumps", S_IWUSR, d->debugfs_phy, | |
559 | priv, &fops_wsm_dumps)) | |
560 | goto err; | |
561 | ||
562 | ret = cw1200_itp_init(priv); | |
563 | if (ret) | |
564 | goto err; | |
565 | ||
566 | return 0; | |
567 | ||
568 | err: | |
569 | priv->debug = NULL; | |
570 | debugfs_remove_recursive(d->debugfs_phy); | |
571 | kfree(d); | |
572 | return ret; | |
573 | } | |
574 | ||
575 | void cw1200_debug_release(struct cw1200_common *priv) | |
576 | { | |
577 | struct cw1200_debug_priv *d = priv->debug; | |
578 | if (d) { | |
579 | cw1200_itp_release(priv); | |
580 | priv->debug = NULL; | |
581 | kfree(d); | |
582 | } | |
583 | } | |
584 | ||
585 | #ifdef CONFIG_CW1200_ETF | |
586 | struct cw1200_sdd { | |
587 | u8 id; | |
588 | u8 len; | |
589 | u8 data[]; | |
590 | }; | |
591 | ||
592 | struct etf_req_msg { | |
593 | u32 id; | |
594 | u32 len; | |
595 | u8 data[]; | |
596 | }; | |
597 | ||
598 | static int parse_sdd_file(struct cw1200_common *priv, u8 *data, u32 length) | |
599 | { | |
600 | struct cw1200_sdd *ie; | |
601 | ||
602 | while (length > 0) { | |
603 | ie = (struct cw1200_sdd *)data; | |
604 | if (ie->id == SDD_REFERENCE_FREQUENCY_ELT_ID) { | |
605 | priv->hw_refclk = cpu_to_le16(*((u16 *)ie->data)); | |
606 | pr_info("Using Reference clock frequency %d KHz\n", | |
607 | priv->hw_refclk); | |
608 | break; | |
609 | } | |
610 | ||
611 | length -= ie->len + sizeof(*ie); | |
612 | data += ie->len + sizeof(*ie); | |
613 | } | |
614 | return 0; | |
615 | } | |
616 | ||
617 | char *etf_firmware; | |
618 | ||
619 | #define ST90TDS_START_ADAPTER 0x09 /* Loads firmware too */ | |
620 | #define ST90TDS_STOP_ADAPTER 0x0A | |
621 | #define ST90TDS_CONFIG_ADAPTER 0x0E /* Send configuration params */ | |
622 | #define ST90TDS_SBUS_READ 0x13 | |
623 | #define ST90TDS_SBUS_WRITE 0x14 | |
624 | #define ST90TDS_GET_DEVICE_OPTION 0x19 | |
625 | #define ST90TDS_SET_DEVICE_OPTION 0x1A | |
626 | #define ST90TDS_SEND_SDD 0x1D /* SDD File used to find DPLL */ | |
627 | ||
628 | #include "fwio.h" | |
629 | ||
630 | static int etf_request(struct cw1200_common *priv, | |
631 | struct etf_req_msg *msg, | |
632 | u32 len) | |
633 | { | |
634 | int rval = -1; | |
635 | switch (msg->id) { | |
636 | case ST90TDS_START_ADAPTER: | |
637 | etf_firmware = "cw1200_etf.bin"; | |
638 | pr_info("ETF_START (len %d, '%s')\n", len, etf_firmware); | |
639 | rval = cw1200_load_firmware(priv); | |
640 | break; | |
641 | case ST90TDS_STOP_ADAPTER: | |
642 | pr_info("ETF_STOP (unhandled)\n"); | |
643 | break; | |
644 | case ST90TDS_SEND_SDD: | |
645 | pr_info("ETF_SDD\n"); | |
646 | rval = parse_sdd_file(priv, msg->data, msg->len); | |
647 | break; | |
648 | case ST90TDS_CONFIG_ADAPTER: | |
649 | pr_info("ETF_CONFIG_ADAP (unhandled)\n"); | |
650 | break; | |
651 | case ST90TDS_SBUS_READ: | |
652 | pr_info("ETF_SBUS_READ (unhandled)\n"); | |
653 | break; | |
654 | case ST90TDS_SBUS_WRITE: | |
655 | pr_info("ETF_SBUS_WRITE (unhandled)\n"); | |
656 | break; | |
657 | case ST90TDS_SET_DEVICE_OPTION: | |
658 | pr_info("ETF_SET_DEV_OPT (unhandled)\n"); | |
659 | break; | |
660 | default: | |
661 | pr_info("ETF_PASSTHRU (0x%08x)\n", msg->id); | |
662 | rval = wsm_raw_cmd(priv, (u8 *)msg, len); | |
663 | break; | |
664 | } | |
665 | ||
666 | return rval; | |
667 | } | |
668 | #endif /* CONFIG_CW1200_ETF */ |