debugfs.c 31 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330
  1. /*
  2. * This file is part of wl1271
  3. *
  4. * Copyright (C) 2009 Nokia Corporation
  5. *
  6. * Contact: Luciano Coelho <luciano.coelho@nokia.com>
  7. *
  8. * This program is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU General Public License
  10. * version 2 as published by the Free Software Foundation.
  11. *
  12. * This program is distributed in the hope that it will be useful, but
  13. * WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  15. * General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  20. * 02110-1301 USA
  21. *
  22. */
  23. #include "debugfs.h"
  24. #include <linux/skbuff.h>
  25. #include <linux/slab.h>
  26. #include <linux/module.h>
  27. #include "wlcore.h"
  28. #include "debug.h"
  29. #include "acx.h"
  30. #include "ps.h"
  31. #include "io.h"
  32. #include "tx.h"
  33. #include "hw_ops.h"
  34. /* ms */
  35. #define WL1271_DEBUGFS_STATS_LIFETIME 1000
  36. #define WLCORE_MAX_BLOCK_SIZE ((size_t)(4*PAGE_SIZE))
  37. /* debugfs macros idea from mac80211 */
  38. int wl1271_format_buffer(char __user *userbuf, size_t count,
  39. loff_t *ppos, char *fmt, ...)
  40. {
  41. va_list args;
  42. char buf[DEBUGFS_FORMAT_BUFFER_SIZE];
  43. int res;
  44. va_start(args, fmt);
  45. res = vscnprintf(buf, sizeof(buf), fmt, args);
  46. va_end(args);
  47. return simple_read_from_buffer(userbuf, count, ppos, buf, res);
  48. }
  49. EXPORT_SYMBOL_GPL(wl1271_format_buffer);
  50. void wl1271_debugfs_update_stats(struct wl1271 *wl)
  51. {
  52. int ret;
  53. mutex_lock(&wl->mutex);
  54. if (unlikely(wl->state != WLCORE_STATE_ON))
  55. goto out;
  56. ret = wl1271_ps_elp_wakeup(wl);
  57. if (ret < 0)
  58. goto out;
  59. if (!wl->plt &&
  60. time_after(jiffies, wl->stats.fw_stats_update +
  61. msecs_to_jiffies(WL1271_DEBUGFS_STATS_LIFETIME))) {
  62. wl1271_acx_statistics(wl, wl->stats.fw_stats);
  63. wl->stats.fw_stats_update = jiffies;
  64. }
  65. wl1271_ps_elp_sleep(wl);
  66. out:
  67. mutex_unlock(&wl->mutex);
  68. }
  69. EXPORT_SYMBOL_GPL(wl1271_debugfs_update_stats);
  70. DEBUGFS_READONLY_FILE(retry_count, "%u", wl->stats.retry_count);
  71. DEBUGFS_READONLY_FILE(excessive_retries, "%u",
  72. wl->stats.excessive_retries);
  73. static ssize_t tx_queue_len_read(struct file *file, char __user *userbuf,
  74. size_t count, loff_t *ppos)
  75. {
  76. struct wl1271 *wl = file->private_data;
  77. u32 queue_len;
  78. char buf[20];
  79. int res;
  80. queue_len = wl1271_tx_total_queue_count(wl);
  81. res = scnprintf(buf, sizeof(buf), "%u\n", queue_len);
  82. return simple_read_from_buffer(userbuf, count, ppos, buf, res);
  83. }
  84. static const struct file_operations tx_queue_len_ops = {
  85. .read = tx_queue_len_read,
  86. .open = simple_open,
  87. .llseek = default_llseek,
  88. };
  89. static void chip_op_handler(struct wl1271 *wl, unsigned long value,
  90. void *arg)
  91. {
  92. int ret;
  93. int (*chip_op) (struct wl1271 *wl);
  94. if (!arg) {
  95. wl1271_warning("debugfs chip_op_handler with no callback");
  96. return;
  97. }
  98. ret = wl1271_ps_elp_wakeup(wl);
  99. if (ret < 0)
  100. return;
  101. chip_op = arg;
  102. chip_op(wl);
  103. wl1271_ps_elp_sleep(wl);
  104. }
  105. static inline void no_write_handler(struct wl1271 *wl,
  106. unsigned long value,
  107. unsigned long param)
  108. {
  109. }
  110. #define WL12XX_CONF_DEBUGFS(param, conf_sub_struct, \
  111. min_val, max_val, write_handler_locked, \
  112. write_handler_arg) \
  113. static ssize_t param##_read(struct file *file, \
  114. char __user *user_buf, \
  115. size_t count, loff_t *ppos) \
  116. { \
  117. struct wl1271 *wl = file->private_data; \
  118. return wl1271_format_buffer(user_buf, count, \
  119. ppos, "%d\n", \
  120. wl->conf.conf_sub_struct.param); \
  121. } \
  122. \
  123. static ssize_t param##_write(struct file *file, \
  124. const char __user *user_buf, \
  125. size_t count, loff_t *ppos) \
  126. { \
  127. struct wl1271 *wl = file->private_data; \
  128. unsigned long value; \
  129. int ret; \
  130. \
  131. ret = kstrtoul_from_user(user_buf, count, 10, &value); \
  132. if (ret < 0) { \
  133. wl1271_warning("illegal value for " #param); \
  134. return -EINVAL; \
  135. } \
  136. \
  137. if (value < min_val || value > max_val) { \
  138. wl1271_warning(#param " is not in valid range"); \
  139. return -ERANGE; \
  140. } \
  141. \
  142. mutex_lock(&wl->mutex); \
  143. wl->conf.conf_sub_struct.param = value; \
  144. \
  145. write_handler_locked(wl, value, write_handler_arg); \
  146. \
  147. mutex_unlock(&wl->mutex); \
  148. return count; \
  149. } \
  150. \
  151. static const struct file_operations param##_ops = { \
  152. .read = param##_read, \
  153. .write = param##_write, \
  154. .open = simple_open, \
  155. .llseek = default_llseek, \
  156. };
  157. WL12XX_CONF_DEBUGFS(irq_pkt_threshold, rx, 0, 65535,
  158. chip_op_handler, wl1271_acx_init_rx_interrupt)
  159. WL12XX_CONF_DEBUGFS(irq_blk_threshold, rx, 0, 65535,
  160. chip_op_handler, wl1271_acx_init_rx_interrupt)
  161. WL12XX_CONF_DEBUGFS(irq_timeout, rx, 0, 100,
  162. chip_op_handler, wl1271_acx_init_rx_interrupt)
  163. static ssize_t gpio_power_read(struct file *file, char __user *user_buf,
  164. size_t count, loff_t *ppos)
  165. {
  166. struct wl1271 *wl = file->private_data;
  167. bool state = test_bit(WL1271_FLAG_GPIO_POWER, &wl->flags);
  168. int res;
  169. char buf[10];
  170. res = scnprintf(buf, sizeof(buf), "%d\n", state);
  171. return simple_read_from_buffer(user_buf, count, ppos, buf, res);
  172. }
  173. static ssize_t gpio_power_write(struct file *file,
  174. const char __user *user_buf,
  175. size_t count, loff_t *ppos)
  176. {
  177. struct wl1271 *wl = file->private_data;
  178. unsigned long value;
  179. int ret;
  180. ret = kstrtoul_from_user(user_buf, count, 10, &value);
  181. if (ret < 0) {
  182. wl1271_warning("illegal value in gpio_power");
  183. return -EINVAL;
  184. }
  185. mutex_lock(&wl->mutex);
  186. if (value)
  187. wl1271_power_on(wl);
  188. else
  189. wl1271_power_off(wl);
  190. mutex_unlock(&wl->mutex);
  191. return count;
  192. }
  193. static const struct file_operations gpio_power_ops = {
  194. .read = gpio_power_read,
  195. .write = gpio_power_write,
  196. .open = simple_open,
  197. .llseek = default_llseek,
  198. };
  199. static ssize_t start_recovery_write(struct file *file,
  200. const char __user *user_buf,
  201. size_t count, loff_t *ppos)
  202. {
  203. struct wl1271 *wl = file->private_data;
  204. mutex_lock(&wl->mutex);
  205. wl12xx_queue_recovery_work(wl);
  206. mutex_unlock(&wl->mutex);
  207. return count;
  208. }
  209. static const struct file_operations start_recovery_ops = {
  210. .write = start_recovery_write,
  211. .open = simple_open,
  212. .llseek = default_llseek,
  213. };
  214. static ssize_t dynamic_ps_timeout_read(struct file *file, char __user *user_buf,
  215. size_t count, loff_t *ppos)
  216. {
  217. struct wl1271 *wl = file->private_data;
  218. return wl1271_format_buffer(user_buf, count,
  219. ppos, "%d\n",
  220. wl->conf.conn.dynamic_ps_timeout);
  221. }
  222. static ssize_t dynamic_ps_timeout_write(struct file *file,
  223. const char __user *user_buf,
  224. size_t count, loff_t *ppos)
  225. {
  226. struct wl1271 *wl = file->private_data;
  227. struct wl12xx_vif *wlvif;
  228. unsigned long value;
  229. int ret;
  230. ret = kstrtoul_from_user(user_buf, count, 10, &value);
  231. if (ret < 0) {
  232. wl1271_warning("illegal value in dynamic_ps");
  233. return -EINVAL;
  234. }
  235. if (value < 1 || value > 65535) {
  236. wl1271_warning("dyanmic_ps_timeout is not in valid range");
  237. return -ERANGE;
  238. }
  239. mutex_lock(&wl->mutex);
  240. wl->conf.conn.dynamic_ps_timeout = value;
  241. if (unlikely(wl->state != WLCORE_STATE_ON))
  242. goto out;
  243. ret = wl1271_ps_elp_wakeup(wl);
  244. if (ret < 0)
  245. goto out;
  246. /* In case we're already in PSM, trigger it again to set new timeout
  247. * immediately without waiting for re-association
  248. */
  249. wl12xx_for_each_wlvif_sta(wl, wlvif) {
  250. if (test_bit(WLVIF_FLAG_IN_PS, &wlvif->flags))
  251. wl1271_ps_set_mode(wl, wlvif, STATION_AUTO_PS_MODE);
  252. }
  253. wl1271_ps_elp_sleep(wl);
  254. out:
  255. mutex_unlock(&wl->mutex);
  256. return count;
  257. }
  258. static const struct file_operations dynamic_ps_timeout_ops = {
  259. .read = dynamic_ps_timeout_read,
  260. .write = dynamic_ps_timeout_write,
  261. .open = simple_open,
  262. .llseek = default_llseek,
  263. };
  264. static ssize_t forced_ps_read(struct file *file, char __user *user_buf,
  265. size_t count, loff_t *ppos)
  266. {
  267. struct wl1271 *wl = file->private_data;
  268. return wl1271_format_buffer(user_buf, count,
  269. ppos, "%d\n",
  270. wl->conf.conn.forced_ps);
  271. }
  272. static ssize_t forced_ps_write(struct file *file,
  273. const char __user *user_buf,
  274. size_t count, loff_t *ppos)
  275. {
  276. struct wl1271 *wl = file->private_data;
  277. struct wl12xx_vif *wlvif;
  278. unsigned long value;
  279. int ret, ps_mode;
  280. ret = kstrtoul_from_user(user_buf, count, 10, &value);
  281. if (ret < 0) {
  282. wl1271_warning("illegal value in forced_ps");
  283. return -EINVAL;
  284. }
  285. if (value != 1 && value != 0) {
  286. wl1271_warning("forced_ps should be either 0 or 1");
  287. return -ERANGE;
  288. }
  289. mutex_lock(&wl->mutex);
  290. if (wl->conf.conn.forced_ps == value)
  291. goto out;
  292. wl->conf.conn.forced_ps = value;
  293. if (unlikely(wl->state != WLCORE_STATE_ON))
  294. goto out;
  295. ret = wl1271_ps_elp_wakeup(wl);
  296. if (ret < 0)
  297. goto out;
  298. /* In case we're already in PSM, trigger it again to switch mode
  299. * immediately without waiting for re-association
  300. */
  301. ps_mode = value ? STATION_POWER_SAVE_MODE : STATION_AUTO_PS_MODE;
  302. wl12xx_for_each_wlvif_sta(wl, wlvif) {
  303. if (test_bit(WLVIF_FLAG_IN_PS, &wlvif->flags))
  304. wl1271_ps_set_mode(wl, wlvif, ps_mode);
  305. }
  306. wl1271_ps_elp_sleep(wl);
  307. out:
  308. mutex_unlock(&wl->mutex);
  309. return count;
  310. }
  311. static const struct file_operations forced_ps_ops = {
  312. .read = forced_ps_read,
  313. .write = forced_ps_write,
  314. .open = simple_open,
  315. .llseek = default_llseek,
  316. };
  317. static ssize_t split_scan_timeout_read(struct file *file, char __user *user_buf,
  318. size_t count, loff_t *ppos)
  319. {
  320. struct wl1271 *wl = file->private_data;
  321. return wl1271_format_buffer(user_buf, count,
  322. ppos, "%d\n",
  323. wl->conf.scan.split_scan_timeout / 1000);
  324. }
  325. static ssize_t split_scan_timeout_write(struct file *file,
  326. const char __user *user_buf,
  327. size_t count, loff_t *ppos)
  328. {
  329. struct wl1271 *wl = file->private_data;
  330. unsigned long value;
  331. int ret;
  332. ret = kstrtoul_from_user(user_buf, count, 10, &value);
  333. if (ret < 0) {
  334. wl1271_warning("illegal value in split_scan_timeout");
  335. return -EINVAL;
  336. }
  337. if (value == 0)
  338. wl1271_info("split scan will be disabled");
  339. mutex_lock(&wl->mutex);
  340. wl->conf.scan.split_scan_timeout = value * 1000;
  341. mutex_unlock(&wl->mutex);
  342. return count;
  343. }
  344. static const struct file_operations split_scan_timeout_ops = {
  345. .read = split_scan_timeout_read,
  346. .write = split_scan_timeout_write,
  347. .open = simple_open,
  348. .llseek = default_llseek,
  349. };
  350. static ssize_t driver_state_read(struct file *file, char __user *user_buf,
  351. size_t count, loff_t *ppos)
  352. {
  353. struct wl1271 *wl = file->private_data;
  354. int res = 0;
  355. ssize_t ret;
  356. char *buf;
  357. #define DRIVER_STATE_BUF_LEN 1024
  358. buf = kmalloc(DRIVER_STATE_BUF_LEN, GFP_KERNEL);
  359. if (!buf)
  360. return -ENOMEM;
  361. mutex_lock(&wl->mutex);
  362. #define DRIVER_STATE_PRINT(x, fmt) \
  363. (res += scnprintf(buf + res, DRIVER_STATE_BUF_LEN - res,\
  364. #x " = " fmt "\n", wl->x))
  365. #define DRIVER_STATE_PRINT_LONG(x) DRIVER_STATE_PRINT(x, "%ld")
  366. #define DRIVER_STATE_PRINT_INT(x) DRIVER_STATE_PRINT(x, "%d")
  367. #define DRIVER_STATE_PRINT_STR(x) DRIVER_STATE_PRINT(x, "%s")
  368. #define DRIVER_STATE_PRINT_LHEX(x) DRIVER_STATE_PRINT(x, "0x%lx")
  369. #define DRIVER_STATE_PRINT_HEX(x) DRIVER_STATE_PRINT(x, "0x%x")
  370. DRIVER_STATE_PRINT_INT(tx_blocks_available);
  371. DRIVER_STATE_PRINT_INT(tx_allocated_blocks);
  372. DRIVER_STATE_PRINT_INT(tx_allocated_pkts[0]);
  373. DRIVER_STATE_PRINT_INT(tx_allocated_pkts[1]);
  374. DRIVER_STATE_PRINT_INT(tx_allocated_pkts[2]);
  375. DRIVER_STATE_PRINT_INT(tx_allocated_pkts[3]);
  376. DRIVER_STATE_PRINT_INT(tx_frames_cnt);
  377. DRIVER_STATE_PRINT_LHEX(tx_frames_map[0]);
  378. DRIVER_STATE_PRINT_INT(tx_queue_count[0]);
  379. DRIVER_STATE_PRINT_INT(tx_queue_count[1]);
  380. DRIVER_STATE_PRINT_INT(tx_queue_count[2]);
  381. DRIVER_STATE_PRINT_INT(tx_queue_count[3]);
  382. DRIVER_STATE_PRINT_INT(tx_packets_count);
  383. DRIVER_STATE_PRINT_INT(tx_results_count);
  384. DRIVER_STATE_PRINT_LHEX(flags);
  385. DRIVER_STATE_PRINT_INT(tx_blocks_freed);
  386. DRIVER_STATE_PRINT_INT(rx_counter);
  387. DRIVER_STATE_PRINT_INT(state);
  388. DRIVER_STATE_PRINT_INT(channel);
  389. DRIVER_STATE_PRINT_INT(band);
  390. DRIVER_STATE_PRINT_INT(power_level);
  391. DRIVER_STATE_PRINT_INT(sg_enabled);
  392. DRIVER_STATE_PRINT_INT(enable_11a);
  393. DRIVER_STATE_PRINT_INT(noise);
  394. DRIVER_STATE_PRINT_HEX(ap_fw_ps_map);
  395. DRIVER_STATE_PRINT_LHEX(ap_ps_map);
  396. DRIVER_STATE_PRINT_HEX(quirks);
  397. DRIVER_STATE_PRINT_HEX(irq);
  398. /* TODO: ref_clock and tcxo_clock were moved to wl12xx priv */
  399. DRIVER_STATE_PRINT_HEX(hw_pg_ver);
  400. DRIVER_STATE_PRINT_HEX(platform_quirks);
  401. DRIVER_STATE_PRINT_HEX(chip.id);
  402. DRIVER_STATE_PRINT_STR(chip.fw_ver_str);
  403. DRIVER_STATE_PRINT_STR(chip.phy_fw_ver_str);
  404. DRIVER_STATE_PRINT_INT(recovery_count);
  405. #undef DRIVER_STATE_PRINT_INT
  406. #undef DRIVER_STATE_PRINT_LONG
  407. #undef DRIVER_STATE_PRINT_HEX
  408. #undef DRIVER_STATE_PRINT_LHEX
  409. #undef DRIVER_STATE_PRINT_STR
  410. #undef DRIVER_STATE_PRINT
  411. #undef DRIVER_STATE_BUF_LEN
  412. mutex_unlock(&wl->mutex);
  413. ret = simple_read_from_buffer(user_buf, count, ppos, buf, res);
  414. kfree(buf);
  415. return ret;
  416. }
  417. static const struct file_operations driver_state_ops = {
  418. .read = driver_state_read,
  419. .open = simple_open,
  420. .llseek = default_llseek,
  421. };
  422. static ssize_t vifs_state_read(struct file *file, char __user *user_buf,
  423. size_t count, loff_t *ppos)
  424. {
  425. struct wl1271 *wl = file->private_data;
  426. struct wl12xx_vif *wlvif;
  427. int ret, res = 0;
  428. const int buf_size = 4096;
  429. char *buf;
  430. char tmp_buf[64];
  431. buf = kzalloc(buf_size, GFP_KERNEL);
  432. if (!buf)
  433. return -ENOMEM;
  434. mutex_lock(&wl->mutex);
  435. #define VIF_STATE_PRINT(x, fmt) \
  436. (res += scnprintf(buf + res, buf_size - res, \
  437. #x " = " fmt "\n", wlvif->x))
  438. #define VIF_STATE_PRINT_LONG(x) VIF_STATE_PRINT(x, "%ld")
  439. #define VIF_STATE_PRINT_INT(x) VIF_STATE_PRINT(x, "%d")
  440. #define VIF_STATE_PRINT_STR(x) VIF_STATE_PRINT(x, "%s")
  441. #define VIF_STATE_PRINT_LHEX(x) VIF_STATE_PRINT(x, "0x%lx")
  442. #define VIF_STATE_PRINT_LLHEX(x) VIF_STATE_PRINT(x, "0x%llx")
  443. #define VIF_STATE_PRINT_HEX(x) VIF_STATE_PRINT(x, "0x%x")
  444. #define VIF_STATE_PRINT_NSTR(x, len) \
  445. do { \
  446. memset(tmp_buf, 0, sizeof(tmp_buf)); \
  447. memcpy(tmp_buf, wlvif->x, \
  448. min_t(u8, len, sizeof(tmp_buf) - 1)); \
  449. res += scnprintf(buf + res, buf_size - res, \
  450. #x " = %s\n", tmp_buf); \
  451. } while (0)
  452. wl12xx_for_each_wlvif(wl, wlvif) {
  453. VIF_STATE_PRINT_INT(role_id);
  454. VIF_STATE_PRINT_INT(bss_type);
  455. VIF_STATE_PRINT_LHEX(flags);
  456. VIF_STATE_PRINT_INT(p2p);
  457. VIF_STATE_PRINT_INT(dev_role_id);
  458. VIF_STATE_PRINT_INT(dev_hlid);
  459. if (wlvif->bss_type == BSS_TYPE_STA_BSS ||
  460. wlvif->bss_type == BSS_TYPE_IBSS) {
  461. VIF_STATE_PRINT_INT(sta.hlid);
  462. VIF_STATE_PRINT_INT(sta.basic_rate_idx);
  463. VIF_STATE_PRINT_INT(sta.ap_rate_idx);
  464. VIF_STATE_PRINT_INT(sta.p2p_rate_idx);
  465. VIF_STATE_PRINT_INT(sta.qos);
  466. } else {
  467. VIF_STATE_PRINT_INT(ap.global_hlid);
  468. VIF_STATE_PRINT_INT(ap.bcast_hlid);
  469. VIF_STATE_PRINT_LHEX(ap.sta_hlid_map[0]);
  470. VIF_STATE_PRINT_INT(ap.mgmt_rate_idx);
  471. VIF_STATE_PRINT_INT(ap.bcast_rate_idx);
  472. VIF_STATE_PRINT_INT(ap.ucast_rate_idx[0]);
  473. VIF_STATE_PRINT_INT(ap.ucast_rate_idx[1]);
  474. VIF_STATE_PRINT_INT(ap.ucast_rate_idx[2]);
  475. VIF_STATE_PRINT_INT(ap.ucast_rate_idx[3]);
  476. }
  477. VIF_STATE_PRINT_INT(last_tx_hlid);
  478. VIF_STATE_PRINT_INT(tx_queue_count[0]);
  479. VIF_STATE_PRINT_INT(tx_queue_count[1]);
  480. VIF_STATE_PRINT_INT(tx_queue_count[2]);
  481. VIF_STATE_PRINT_INT(tx_queue_count[3]);
  482. VIF_STATE_PRINT_LHEX(links_map[0]);
  483. VIF_STATE_PRINT_NSTR(ssid, wlvif->ssid_len);
  484. VIF_STATE_PRINT_INT(band);
  485. VIF_STATE_PRINT_INT(channel);
  486. VIF_STATE_PRINT_HEX(bitrate_masks[0]);
  487. VIF_STATE_PRINT_HEX(bitrate_masks[1]);
  488. VIF_STATE_PRINT_HEX(basic_rate_set);
  489. VIF_STATE_PRINT_HEX(basic_rate);
  490. VIF_STATE_PRINT_HEX(rate_set);
  491. VIF_STATE_PRINT_INT(beacon_int);
  492. VIF_STATE_PRINT_INT(default_key);
  493. VIF_STATE_PRINT_INT(aid);
  494. VIF_STATE_PRINT_INT(psm_entry_retry);
  495. VIF_STATE_PRINT_INT(power_level);
  496. VIF_STATE_PRINT_INT(rssi_thold);
  497. VIF_STATE_PRINT_INT(last_rssi_event);
  498. VIF_STATE_PRINT_INT(ba_support);
  499. VIF_STATE_PRINT_INT(ba_allowed);
  500. VIF_STATE_PRINT_LLHEX(total_freed_pkts);
  501. }
  502. #undef VIF_STATE_PRINT_INT
  503. #undef VIF_STATE_PRINT_LONG
  504. #undef VIF_STATE_PRINT_HEX
  505. #undef VIF_STATE_PRINT_LHEX
  506. #undef VIF_STATE_PRINT_LLHEX
  507. #undef VIF_STATE_PRINT_STR
  508. #undef VIF_STATE_PRINT_NSTR
  509. #undef VIF_STATE_PRINT
  510. mutex_unlock(&wl->mutex);
  511. ret = simple_read_from_buffer(user_buf, count, ppos, buf, res);
  512. kfree(buf);
  513. return ret;
  514. }
  515. static const struct file_operations vifs_state_ops = {
  516. .read = vifs_state_read,
  517. .open = simple_open,
  518. .llseek = default_llseek,
  519. };
  520. static ssize_t dtim_interval_read(struct file *file, char __user *user_buf,
  521. size_t count, loff_t *ppos)
  522. {
  523. struct wl1271 *wl = file->private_data;
  524. u8 value;
  525. if (wl->conf.conn.wake_up_event == CONF_WAKE_UP_EVENT_DTIM ||
  526. wl->conf.conn.wake_up_event == CONF_WAKE_UP_EVENT_N_DTIM)
  527. value = wl->conf.conn.listen_interval;
  528. else
  529. value = 0;
  530. return wl1271_format_buffer(user_buf, count, ppos, "%d\n", value);
  531. }
  532. static ssize_t dtim_interval_write(struct file *file,
  533. const char __user *user_buf,
  534. size_t count, loff_t *ppos)
  535. {
  536. struct wl1271 *wl = file->private_data;
  537. unsigned long value;
  538. int ret;
  539. ret = kstrtoul_from_user(user_buf, count, 10, &value);
  540. if (ret < 0) {
  541. wl1271_warning("illegal value for dtim_interval");
  542. return -EINVAL;
  543. }
  544. if (value < 1 || value > 10) {
  545. wl1271_warning("dtim value is not in valid range");
  546. return -ERANGE;
  547. }
  548. mutex_lock(&wl->mutex);
  549. wl->conf.conn.listen_interval = value;
  550. /* for some reason there are different event types for 1 and >1 */
  551. if (value == 1)
  552. wl->conf.conn.wake_up_event = CONF_WAKE_UP_EVENT_DTIM;
  553. else
  554. wl->conf.conn.wake_up_event = CONF_WAKE_UP_EVENT_N_DTIM;
  555. /*
  556. * we don't reconfigure ACX_WAKE_UP_CONDITIONS now, so it will only
  557. * take effect on the next time we enter psm.
  558. */
  559. mutex_unlock(&wl->mutex);
  560. return count;
  561. }
  562. static const struct file_operations dtim_interval_ops = {
  563. .read = dtim_interval_read,
  564. .write = dtim_interval_write,
  565. .open = simple_open,
  566. .llseek = default_llseek,
  567. };
  568. static ssize_t suspend_dtim_interval_read(struct file *file,
  569. char __user *user_buf,
  570. size_t count, loff_t *ppos)
  571. {
  572. struct wl1271 *wl = file->private_data;
  573. u8 value;
  574. if (wl->conf.conn.suspend_wake_up_event == CONF_WAKE_UP_EVENT_DTIM ||
  575. wl->conf.conn.suspend_wake_up_event == CONF_WAKE_UP_EVENT_N_DTIM)
  576. value = wl->conf.conn.suspend_listen_interval;
  577. else
  578. value = 0;
  579. return wl1271_format_buffer(user_buf, count, ppos, "%d\n", value);
  580. }
  581. static ssize_t suspend_dtim_interval_write(struct file *file,
  582. const char __user *user_buf,
  583. size_t count, loff_t *ppos)
  584. {
  585. struct wl1271 *wl = file->private_data;
  586. unsigned long value;
  587. int ret;
  588. ret = kstrtoul_from_user(user_buf, count, 10, &value);
  589. if (ret < 0) {
  590. wl1271_warning("illegal value for suspend_dtim_interval");
  591. return -EINVAL;
  592. }
  593. if (value < 1 || value > 10) {
  594. wl1271_warning("suspend_dtim value is not in valid range");
  595. return -ERANGE;
  596. }
  597. mutex_lock(&wl->mutex);
  598. wl->conf.conn.suspend_listen_interval = value;
  599. /* for some reason there are different event types for 1 and >1 */
  600. if (value == 1)
  601. wl->conf.conn.suspend_wake_up_event = CONF_WAKE_UP_EVENT_DTIM;
  602. else
  603. wl->conf.conn.suspend_wake_up_event = CONF_WAKE_UP_EVENT_N_DTIM;
  604. mutex_unlock(&wl->mutex);
  605. return count;
  606. }
  607. static const struct file_operations suspend_dtim_interval_ops = {
  608. .read = suspend_dtim_interval_read,
  609. .write = suspend_dtim_interval_write,
  610. .open = simple_open,
  611. .llseek = default_llseek,
  612. };
  613. static ssize_t beacon_interval_read(struct file *file, char __user *user_buf,
  614. size_t count, loff_t *ppos)
  615. {
  616. struct wl1271 *wl = file->private_data;
  617. u8 value;
  618. if (wl->conf.conn.wake_up_event == CONF_WAKE_UP_EVENT_BEACON ||
  619. wl->conf.conn.wake_up_event == CONF_WAKE_UP_EVENT_N_BEACONS)
  620. value = wl->conf.conn.listen_interval;
  621. else
  622. value = 0;
  623. return wl1271_format_buffer(user_buf, count, ppos, "%d\n", value);
  624. }
  625. static ssize_t beacon_interval_write(struct file *file,
  626. const char __user *user_buf,
  627. size_t count, loff_t *ppos)
  628. {
  629. struct wl1271 *wl = file->private_data;
  630. unsigned long value;
  631. int ret;
  632. ret = kstrtoul_from_user(user_buf, count, 10, &value);
  633. if (ret < 0) {
  634. wl1271_warning("illegal value for beacon_interval");
  635. return -EINVAL;
  636. }
  637. if (value < 1 || value > 255) {
  638. wl1271_warning("beacon interval value is not in valid range");
  639. return -ERANGE;
  640. }
  641. mutex_lock(&wl->mutex);
  642. wl->conf.conn.listen_interval = value;
  643. /* for some reason there are different event types for 1 and >1 */
  644. if (value == 1)
  645. wl->conf.conn.wake_up_event = CONF_WAKE_UP_EVENT_BEACON;
  646. else
  647. wl->conf.conn.wake_up_event = CONF_WAKE_UP_EVENT_N_BEACONS;
  648. /*
  649. * we don't reconfigure ACX_WAKE_UP_CONDITIONS now, so it will only
  650. * take effect on the next time we enter psm.
  651. */
  652. mutex_unlock(&wl->mutex);
  653. return count;
  654. }
  655. static const struct file_operations beacon_interval_ops = {
  656. .read = beacon_interval_read,
  657. .write = beacon_interval_write,
  658. .open = simple_open,
  659. .llseek = default_llseek,
  660. };
  661. static ssize_t rx_streaming_interval_write(struct file *file,
  662. const char __user *user_buf,
  663. size_t count, loff_t *ppos)
  664. {
  665. struct wl1271 *wl = file->private_data;
  666. struct wl12xx_vif *wlvif;
  667. unsigned long value;
  668. int ret;
  669. ret = kstrtoul_from_user(user_buf, count, 10, &value);
  670. if (ret < 0) {
  671. wl1271_warning("illegal value in rx_streaming_interval!");
  672. return -EINVAL;
  673. }
  674. /* valid values: 0, 10-100 */
  675. if (value && (value < 10 || value > 100)) {
  676. wl1271_warning("value is not in range!");
  677. return -ERANGE;
  678. }
  679. mutex_lock(&wl->mutex);
  680. wl->conf.rx_streaming.interval = value;
  681. ret = wl1271_ps_elp_wakeup(wl);
  682. if (ret < 0)
  683. goto out;
  684. wl12xx_for_each_wlvif_sta(wl, wlvif) {
  685. wl1271_recalc_rx_streaming(wl, wlvif);
  686. }
  687. wl1271_ps_elp_sleep(wl);
  688. out:
  689. mutex_unlock(&wl->mutex);
  690. return count;
  691. }
  692. static ssize_t rx_streaming_interval_read(struct file *file,
  693. char __user *userbuf,
  694. size_t count, loff_t *ppos)
  695. {
  696. struct wl1271 *wl = file->private_data;
  697. return wl1271_format_buffer(userbuf, count, ppos,
  698. "%d\n", wl->conf.rx_streaming.interval);
  699. }
  700. static const struct file_operations rx_streaming_interval_ops = {
  701. .read = rx_streaming_interval_read,
  702. .write = rx_streaming_interval_write,
  703. .open = simple_open,
  704. .llseek = default_llseek,
  705. };
  706. static ssize_t rx_streaming_always_write(struct file *file,
  707. const char __user *user_buf,
  708. size_t count, loff_t *ppos)
  709. {
  710. struct wl1271 *wl = file->private_data;
  711. struct wl12xx_vif *wlvif;
  712. unsigned long value;
  713. int ret;
  714. ret = kstrtoul_from_user(user_buf, count, 10, &value);
  715. if (ret < 0) {
  716. wl1271_warning("illegal value in rx_streaming_write!");
  717. return -EINVAL;
  718. }
  719. /* valid values: 0, 10-100 */
  720. if (!(value == 0 || value == 1)) {
  721. wl1271_warning("value is not in valid!");
  722. return -EINVAL;
  723. }
  724. mutex_lock(&wl->mutex);
  725. wl->conf.rx_streaming.always = value;
  726. ret = wl1271_ps_elp_wakeup(wl);
  727. if (ret < 0)
  728. goto out;
  729. wl12xx_for_each_wlvif_sta(wl, wlvif) {
  730. wl1271_recalc_rx_streaming(wl, wlvif);
  731. }
  732. wl1271_ps_elp_sleep(wl);
  733. out:
  734. mutex_unlock(&wl->mutex);
  735. return count;
  736. }
  737. static ssize_t rx_streaming_always_read(struct file *file,
  738. char __user *userbuf,
  739. size_t count, loff_t *ppos)
  740. {
  741. struct wl1271 *wl = file->private_data;
  742. return wl1271_format_buffer(userbuf, count, ppos,
  743. "%d\n", wl->conf.rx_streaming.always);
  744. }
  745. static const struct file_operations rx_streaming_always_ops = {
  746. .read = rx_streaming_always_read,
  747. .write = rx_streaming_always_write,
  748. .open = simple_open,
  749. .llseek = default_llseek,
  750. };
  751. static ssize_t beacon_filtering_write(struct file *file,
  752. const char __user *user_buf,
  753. size_t count, loff_t *ppos)
  754. {
  755. struct wl1271 *wl = file->private_data;
  756. struct wl12xx_vif *wlvif;
  757. char buf[10];
  758. size_t len;
  759. unsigned long value;
  760. int ret;
  761. len = min(count, sizeof(buf) - 1);
  762. if (copy_from_user(buf, user_buf, len))
  763. return -EFAULT;
  764. buf[len] = '\0';
  765. ret = kstrtoul(buf, 0, &value);
  766. if (ret < 0) {
  767. wl1271_warning("illegal value for beacon_filtering!");
  768. return -EINVAL;
  769. }
  770. mutex_lock(&wl->mutex);
  771. ret = wl1271_ps_elp_wakeup(wl);
  772. if (ret < 0)
  773. goto out;
  774. wl12xx_for_each_wlvif(wl, wlvif) {
  775. ret = wl1271_acx_beacon_filter_opt(wl, wlvif, !!value);
  776. }
  777. wl1271_ps_elp_sleep(wl);
  778. out:
  779. mutex_unlock(&wl->mutex);
  780. return count;
  781. }
  782. static const struct file_operations beacon_filtering_ops = {
  783. .write = beacon_filtering_write,
  784. .open = simple_open,
  785. .llseek = default_llseek,
  786. };
  787. static ssize_t fw_stats_raw_read(struct file *file,
  788. char __user *userbuf,
  789. size_t count, loff_t *ppos)
  790. {
  791. struct wl1271 *wl = file->private_data;
  792. wl1271_debugfs_update_stats(wl);
  793. return simple_read_from_buffer(userbuf, count, ppos,
  794. wl->stats.fw_stats,
  795. wl->stats.fw_stats_len);
  796. }
  797. static const struct file_operations fw_stats_raw_ops = {
  798. .read = fw_stats_raw_read,
  799. .open = simple_open,
  800. .llseek = default_llseek,
  801. };
  802. static ssize_t sleep_auth_read(struct file *file, char __user *user_buf,
  803. size_t count, loff_t *ppos)
  804. {
  805. struct wl1271 *wl = file->private_data;
  806. return wl1271_format_buffer(user_buf, count,
  807. ppos, "%d\n",
  808. wl->sleep_auth);
  809. }
  810. static ssize_t sleep_auth_write(struct file *file,
  811. const char __user *user_buf,
  812. size_t count, loff_t *ppos)
  813. {
  814. struct wl1271 *wl = file->private_data;
  815. unsigned long value;
  816. int ret;
  817. ret = kstrtoul_from_user(user_buf, count, 0, &value);
  818. if (ret < 0) {
  819. wl1271_warning("illegal value in sleep_auth");
  820. return -EINVAL;
  821. }
  822. if (value > WL1271_PSM_MAX) {
  823. wl1271_warning("sleep_auth must be between 0 and %d",
  824. WL1271_PSM_MAX);
  825. return -ERANGE;
  826. }
  827. mutex_lock(&wl->mutex);
  828. wl->conf.conn.sta_sleep_auth = value;
  829. if (unlikely(wl->state != WLCORE_STATE_ON)) {
  830. /* this will show up on "read" in case we are off */
  831. wl->sleep_auth = value;
  832. goto out;
  833. }
  834. ret = wl1271_ps_elp_wakeup(wl);
  835. if (ret < 0)
  836. goto out;
  837. ret = wl1271_acx_sleep_auth(wl, value);
  838. if (ret < 0)
  839. goto out_sleep;
  840. out_sleep:
  841. wl1271_ps_elp_sleep(wl);
  842. out:
  843. mutex_unlock(&wl->mutex);
  844. return count;
  845. }
  846. static const struct file_operations sleep_auth_ops = {
  847. .read = sleep_auth_read,
  848. .write = sleep_auth_write,
  849. .open = simple_open,
  850. .llseek = default_llseek,
  851. };
  852. static ssize_t dev_mem_read(struct file *file,
  853. char __user *user_buf, size_t count,
  854. loff_t *ppos)
  855. {
  856. struct wl1271 *wl = file->private_data;
  857. struct wlcore_partition_set part, old_part;
  858. size_t bytes = count;
  859. int ret;
  860. char *buf;
  861. /* only requests of dword-aligned size and offset are supported */
  862. if (bytes % 4)
  863. return -EINVAL;
  864. if (*ppos % 4)
  865. return -EINVAL;
  866. /* function should return in reasonable time */
  867. bytes = min(bytes, WLCORE_MAX_BLOCK_SIZE);
  868. if (bytes == 0)
  869. return -EINVAL;
  870. memset(&part, 0, sizeof(part));
  871. part.mem.start = file->f_pos;
  872. part.mem.size = bytes;
  873. buf = kmalloc(bytes, GFP_KERNEL);
  874. if (!buf)
  875. return -ENOMEM;
  876. mutex_lock(&wl->mutex);
  877. if (unlikely(wl->state == WLCORE_STATE_OFF)) {
  878. ret = -EFAULT;
  879. goto skip_read;
  880. }
  881. /*
  882. * Don't fail if elp_wakeup returns an error, so the device's memory
  883. * could be read even if the FW crashed
  884. */
  885. wl1271_ps_elp_wakeup(wl);
  886. /* store current partition and switch partition */
  887. memcpy(&old_part, &wl->curr_part, sizeof(old_part));
  888. ret = wlcore_set_partition(wl, &part);
  889. if (ret < 0)
  890. goto part_err;
  891. ret = wlcore_raw_read(wl, 0, buf, bytes, false);
  892. if (ret < 0)
  893. goto read_err;
  894. read_err:
  895. /* recover partition */
  896. ret = wlcore_set_partition(wl, &old_part);
  897. if (ret < 0)
  898. goto part_err;
  899. part_err:
  900. wl1271_ps_elp_sleep(wl);
  901. skip_read:
  902. mutex_unlock(&wl->mutex);
  903. if (ret == 0) {
  904. ret = copy_to_user(user_buf, buf, bytes);
  905. if (ret < bytes) {
  906. bytes -= ret;
  907. *ppos += bytes;
  908. ret = 0;
  909. } else {
  910. ret = -EFAULT;
  911. }
  912. }
  913. kfree(buf);
  914. return ((ret == 0) ? bytes : ret);
  915. }
  916. static ssize_t dev_mem_write(struct file *file, const char __user *user_buf,
  917. size_t count, loff_t *ppos)
  918. {
  919. struct wl1271 *wl = file->private_data;
  920. struct wlcore_partition_set part, old_part;
  921. size_t bytes = count;
  922. int ret;
  923. char *buf;
  924. /* only requests of dword-aligned size and offset are supported */
  925. if (bytes % 4)
  926. return -EINVAL;
  927. if (*ppos % 4)
  928. return -EINVAL;
  929. /* function should return in reasonable time */
  930. bytes = min(bytes, WLCORE_MAX_BLOCK_SIZE);
  931. if (bytes == 0)
  932. return -EINVAL;
  933. memset(&part, 0, sizeof(part));
  934. part.mem.start = file->f_pos;
  935. part.mem.size = bytes;
  936. buf = kmalloc(bytes, GFP_KERNEL);
  937. if (!buf)
  938. return -ENOMEM;
  939. ret = copy_from_user(buf, user_buf, bytes);
  940. if (ret) {
  941. ret = -EFAULT;
  942. goto err_out;
  943. }
  944. mutex_lock(&wl->mutex);
  945. if (unlikely(wl->state == WLCORE_STATE_OFF)) {
  946. ret = -EFAULT;
  947. goto skip_write;
  948. }
  949. /*
  950. * Don't fail if elp_wakeup returns an error, so the device's memory
  951. * could be read even if the FW crashed
  952. */
  953. wl1271_ps_elp_wakeup(wl);
  954. /* store current partition and switch partition */
  955. memcpy(&old_part, &wl->curr_part, sizeof(old_part));
  956. ret = wlcore_set_partition(wl, &part);
  957. if (ret < 0)
  958. goto part_err;
  959. ret = wlcore_raw_write(wl, 0, buf, bytes, false);
  960. if (ret < 0)
  961. goto write_err;
  962. write_err:
  963. /* recover partition */
  964. ret = wlcore_set_partition(wl, &old_part);
  965. if (ret < 0)
  966. goto part_err;
  967. part_err:
  968. wl1271_ps_elp_sleep(wl);
  969. skip_write:
  970. mutex_unlock(&wl->mutex);
  971. if (ret == 0)
  972. *ppos += bytes;
  973. err_out:
  974. kfree(buf);
  975. return ((ret == 0) ? bytes : ret);
  976. }
  977. static loff_t dev_mem_seek(struct file *file, loff_t offset, int orig)
  978. {
  979. loff_t ret;
  980. /* only requests of dword-aligned size and offset are supported */
  981. if (offset % 4)
  982. return -EINVAL;
  983. switch (orig) {
  984. case SEEK_SET:
  985. file->f_pos = offset;
  986. ret = file->f_pos;
  987. break;
  988. case SEEK_CUR:
  989. file->f_pos += offset;
  990. ret = file->f_pos;
  991. break;
  992. default:
  993. ret = -EINVAL;
  994. }
  995. return ret;
  996. }
  997. static const struct file_operations dev_mem_ops = {
  998. .open = simple_open,
  999. .read = dev_mem_read,
  1000. .write = dev_mem_write,
  1001. .llseek = dev_mem_seek,
  1002. };
  1003. static int wl1271_debugfs_add_files(struct wl1271 *wl,
  1004. struct dentry *rootdir)
  1005. {
  1006. int ret = 0;
  1007. struct dentry *entry, *streaming;
  1008. DEBUGFS_ADD(tx_queue_len, rootdir);
  1009. DEBUGFS_ADD(retry_count, rootdir);
  1010. DEBUGFS_ADD(excessive_retries, rootdir);
  1011. DEBUGFS_ADD(gpio_power, rootdir);
  1012. DEBUGFS_ADD(start_recovery, rootdir);
  1013. DEBUGFS_ADD(driver_state, rootdir);
  1014. DEBUGFS_ADD(vifs_state, rootdir);
  1015. DEBUGFS_ADD(dtim_interval, rootdir);
  1016. DEBUGFS_ADD(suspend_dtim_interval, rootdir);
  1017. DEBUGFS_ADD(beacon_interval, rootdir);
  1018. DEBUGFS_ADD(beacon_filtering, rootdir);
  1019. DEBUGFS_ADD(dynamic_ps_timeout, rootdir);
  1020. DEBUGFS_ADD(forced_ps, rootdir);
  1021. DEBUGFS_ADD(split_scan_timeout, rootdir);
  1022. DEBUGFS_ADD(irq_pkt_threshold, rootdir);
  1023. DEBUGFS_ADD(irq_blk_threshold, rootdir);
  1024. DEBUGFS_ADD(irq_timeout, rootdir);
  1025. DEBUGFS_ADD(fw_stats_raw, rootdir);
  1026. DEBUGFS_ADD(sleep_auth, rootdir);
  1027. streaming = debugfs_create_dir("rx_streaming", rootdir);
  1028. if (!streaming || IS_ERR(streaming))
  1029. goto err;
  1030. DEBUGFS_ADD_PREFIX(rx_streaming, interval, streaming);
  1031. DEBUGFS_ADD_PREFIX(rx_streaming, always, streaming);
  1032. DEBUGFS_ADD_PREFIX(dev, mem, rootdir);
  1033. return 0;
  1034. err:
  1035. if (IS_ERR(entry))
  1036. ret = PTR_ERR(entry);
  1037. else
  1038. ret = -ENOMEM;
  1039. return ret;
  1040. }
  1041. void wl1271_debugfs_reset(struct wl1271 *wl)
  1042. {
  1043. if (!wl->stats.fw_stats)
  1044. return;
  1045. memset(wl->stats.fw_stats, 0, wl->stats.fw_stats_len);
  1046. wl->stats.retry_count = 0;
  1047. wl->stats.excessive_retries = 0;
  1048. }
  1049. int wl1271_debugfs_init(struct wl1271 *wl)
  1050. {
  1051. int ret;
  1052. struct dentry *rootdir;
  1053. rootdir = debugfs_create_dir(KBUILD_MODNAME,
  1054. wl->hw->wiphy->debugfsdir);
  1055. if (IS_ERR(rootdir)) {
  1056. ret = PTR_ERR(rootdir);
  1057. goto out;
  1058. }
  1059. wl->stats.fw_stats = kzalloc(wl->stats.fw_stats_len, GFP_KERNEL);
  1060. if (!wl->stats.fw_stats) {
  1061. ret = -ENOMEM;
  1062. goto out_remove;
  1063. }
  1064. wl->stats.fw_stats_update = jiffies;
  1065. ret = wl1271_debugfs_add_files(wl, rootdir);
  1066. if (ret < 0)
  1067. goto out_exit;
  1068. ret = wlcore_debugfs_init(wl, rootdir);
  1069. if (ret < 0)
  1070. goto out_exit;
  1071. goto out;
  1072. out_exit:
  1073. wl1271_debugfs_exit(wl);
  1074. out_remove:
  1075. debugfs_remove_recursive(rootdir);
  1076. out:
  1077. return ret;
  1078. }
  1079. void wl1271_debugfs_exit(struct wl1271 *wl)
  1080. {
  1081. kfree(wl->stats.fw_stats);
  1082. wl->stats.fw_stats = NULL;
  1083. }