linux_ac.c 27 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087
  1. /*
  2. * Copyright (c) 2012-2021 The Linux Foundation. All rights reserved.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for
  5. * any purpose with or without fee is hereby granted, provided that the
  6. * above copyright notice and this permission notice appear in all
  7. * copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  10. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  11. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  12. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  13. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  14. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  15. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  16. * PERFORMANCE OF THIS SOFTWARE.
  17. */
  18. #ifndef REMOVE_PKT_LOG
  19. #ifndef EXPORT_SYMTAB
  20. #define EXPORT_SYMTAB
  21. #endif
  22. #ifndef __KERNEL__
  23. #define __KERNEL__
  24. #endif
  25. /*
  26. * Linux specific implementation of Pktlogs for 802.11ac
  27. */
  28. #include <linux/kernel.h>
  29. #include <linux/init.h>
  30. #include <linux/module.h>
  31. #include <linux/vmalloc.h>
  32. #include <linux/proc_fs.h>
  33. #include <pktlog_ac_i.h>
  34. #include <pktlog_ac_fmt.h>
  35. #include "i_host_diag_core_log.h"
  36. #include "host_diag_core_log.h"
  37. #include "ani_global.h"
  38. #define PKTLOG_DEVNAME_SIZE 32
  39. #define MAX_WLANDEV 1
  40. #ifdef MULTI_IF_NAME
  41. #define PKTLOG_PROC_DIR "ath_pktlog" MULTI_IF_NAME
  42. #else
  43. #define PKTLOG_PROC_DIR "ath_pktlog"
  44. #endif
  45. /* Permissions for creating proc entries */
  46. #define PKTLOG_PROC_PERM 0444
  47. #define PKTLOG_PROCSYS_DIR_PERM 0555
  48. #define PKTLOG_PROCSYS_PERM 0644
  49. #ifndef __MOD_INC_USE_COUNT
  50. #define PKTLOG_MOD_INC_USE_COUNT do { \
  51. if (!try_module_get(THIS_MODULE)) { \
  52. qdf_nofl_info("try_module_get failed"); \
  53. } } while (0)
  54. #define PKTLOG_MOD_DEC_USE_COUNT module_put(THIS_MODULE)
  55. #else
  56. #define PKTLOG_MOD_INC_USE_COUNT MOD_INC_USE_COUNT
  57. #define PKTLOG_MOD_DEC_USE_COUNT MOD_DEC_USE_COUNT
  58. #endif
  59. static struct ath_pktlog_info *g_pktlog_info;
  60. static struct proc_dir_entry *g_pktlog_pde;
  61. static DEFINE_MUTEX(proc_mutex);
  62. static int pktlog_attach(struct hif_opaque_softc *scn);
  63. static void pktlog_detach(struct hif_opaque_softc *scn);
  64. static int pktlog_open(struct inode *i, struct file *f);
  65. static int pktlog_release(struct inode *i, struct file *f);
  66. static ssize_t pktlog_read(struct file *file, char *buf, size_t nbytes,
  67. loff_t *ppos);
  68. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0))
  69. static const struct proc_ops pktlog_fops = {
  70. .proc_open = pktlog_open,
  71. .proc_release = pktlog_release,
  72. .proc_read = pktlog_read,
  73. };
  74. #else
  75. static struct file_operations pktlog_fops = {
  76. open: pktlog_open,
  77. release:pktlog_release,
  78. read : pktlog_read,
  79. };
  80. #endif
  81. void pktlog_disable_adapter_logging(struct hif_opaque_softc *scn)
  82. {
  83. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  84. if (pl_dev)
  85. pl_dev->pl_info->log_state = 0;
  86. }
  87. int pktlog_alloc_buf(struct hif_opaque_softc *scn)
  88. {
  89. uint32_t page_cnt;
  90. unsigned long vaddr;
  91. struct page *vpg;
  92. struct pktlog_dev_t *pl_dev;
  93. struct ath_pktlog_info *pl_info;
  94. struct ath_pktlog_buf *buffer;
  95. pl_dev = get_pktlog_handle();
  96. if (!pl_dev) {
  97. qdf_info(PKTLOG_TAG "pdev_txrx_handle->pl_dev is null");
  98. return -EINVAL;
  99. }
  100. pl_info = pl_dev->pl_info;
  101. page_cnt = (sizeof(*(pl_info->buf)) + pl_info->buf_size) / PAGE_SIZE;
  102. qdf_spin_lock_bh(&pl_info->log_lock);
  103. if (pl_info->buf) {
  104. qdf_spin_unlock_bh(&pl_info->log_lock);
  105. qdf_nofl_info(PKTLOG_TAG "Buffer is already in use");
  106. return -EINVAL;
  107. }
  108. qdf_spin_unlock_bh(&pl_info->log_lock);
  109. buffer = qdf_mem_valloc((page_cnt + 2) * PAGE_SIZE);
  110. if (!buffer) {
  111. return -ENOMEM;
  112. }
  113. buffer = (struct ath_pktlog_buf *)
  114. (((unsigned long)(buffer) + PAGE_SIZE - 1)
  115. & PAGE_MASK);
  116. for (vaddr = (unsigned long)(buffer);
  117. vaddr < ((unsigned long)(buffer) + (page_cnt * PAGE_SIZE));
  118. vaddr += PAGE_SIZE) {
  119. vpg = vmalloc_to_page((const void *)vaddr);
  120. SetPageReserved(vpg);
  121. }
  122. qdf_spin_lock_bh(&pl_info->log_lock);
  123. if (pl_info->buf)
  124. pktlog_release_buf(scn);
  125. pl_info->buf = buffer;
  126. qdf_spin_unlock_bh(&pl_info->log_lock);
  127. return 0;
  128. }
  129. void pktlog_release_buf(struct hif_opaque_softc *scn)
  130. {
  131. unsigned long page_cnt;
  132. unsigned long vaddr;
  133. struct page *vpg;
  134. struct pktlog_dev_t *pl_dev;
  135. struct ath_pktlog_info *pl_info;
  136. pl_dev = get_pktlog_handle();
  137. if (!pl_dev) {
  138. qdf_print("Invalid pl_dev handle");
  139. return;
  140. }
  141. if (!pl_dev->pl_info) {
  142. qdf_print("Invalid pl_dev handle");
  143. return;
  144. }
  145. pl_info = pl_dev->pl_info;
  146. page_cnt = ((sizeof(*(pl_info->buf)) + pl_info->buf_size) /
  147. PAGE_SIZE) + 1;
  148. for (vaddr = (unsigned long)(pl_info->buf);
  149. vaddr < (unsigned long)(pl_info->buf) + (page_cnt * PAGE_SIZE);
  150. vaddr += PAGE_SIZE) {
  151. vpg = vmalloc_to_page((const void *)vaddr);
  152. ClearPageReserved(vpg);
  153. }
  154. qdf_mem_vfree(pl_info->buf);
  155. pl_info->buf = NULL;
  156. }
  157. static void pktlog_cleanup(struct ath_pktlog_info *pl_info)
  158. {
  159. pl_info->log_state = 0;
  160. PKTLOG_LOCK_DESTROY(pl_info);
  161. mutex_destroy(&pl_info->pktlog_mutex);
  162. }
  163. /* sysctl procfs handler to enable pktlog */
  164. static int
  165. qdf_sysctl_decl(ath_sysctl_pktlog_enable, ctl, write, filp, buffer, lenp, ppos)
  166. {
  167. int ret, enable;
  168. ol_ath_generic_softc_handle scn;
  169. struct pktlog_dev_t *pl_dev;
  170. mutex_lock(&proc_mutex);
  171. scn = (ol_ath_generic_softc_handle) ctl->extra1;
  172. if (!scn) {
  173. mutex_unlock(&proc_mutex);
  174. qdf_info("Invalid scn context");
  175. ASSERT(0);
  176. return -EINVAL;
  177. }
  178. pl_dev = get_pktlog_handle();
  179. if (!pl_dev) {
  180. mutex_unlock(&proc_mutex);
  181. qdf_info("Invalid pktlog context");
  182. ASSERT(0);
  183. return -ENODEV;
  184. }
  185. ctl->data = &enable;
  186. ctl->maxlen = sizeof(enable);
  187. if (write) {
  188. ret = QDF_SYSCTL_PROC_DOINTVEC(ctl, write, filp, buffer,
  189. lenp, ppos);
  190. if (ret == 0) {
  191. ret = pl_dev->pl_funcs->pktlog_enable(
  192. (struct hif_opaque_softc *)scn, enable,
  193. cds_is_packet_log_enabled(), 0, 1);
  194. }
  195. else
  196. QDF_TRACE(QDF_MODULE_ID_SYS, QDF_TRACE_LEVEL_DEBUG,
  197. "Line:%d %s:proc_dointvec failed reason %d",
  198. __LINE__, __func__, ret);
  199. } else {
  200. ret = QDF_SYSCTL_PROC_DOINTVEC(ctl, write, filp, buffer,
  201. lenp, ppos);
  202. if (ret)
  203. QDF_TRACE(QDF_MODULE_ID_SYS, QDF_TRACE_LEVEL_DEBUG,
  204. "Line:%d %s:proc_dointvec failed reason %d",
  205. __LINE__, __func__, ret);
  206. }
  207. ctl->data = NULL;
  208. ctl->maxlen = 0;
  209. mutex_unlock(&proc_mutex);
  210. return ret;
  211. }
  212. static int get_pktlog_bufsize(struct pktlog_dev_t *pl_dev)
  213. {
  214. return pl_dev->pl_info->buf_size;
  215. }
  216. /* sysctl procfs handler to set/get pktlog size */
  217. static int
  218. qdf_sysctl_decl(ath_sysctl_pktlog_size, ctl, write, filp, buffer, lenp, ppos)
  219. {
  220. int ret, size;
  221. ol_ath_generic_softc_handle scn;
  222. struct pktlog_dev_t *pl_dev;
  223. mutex_lock(&proc_mutex);
  224. scn = (ol_ath_generic_softc_handle) ctl->extra1;
  225. if (!scn) {
  226. mutex_unlock(&proc_mutex);
  227. qdf_info("Invalid scn context");
  228. ASSERT(0);
  229. return -EINVAL;
  230. }
  231. pl_dev = get_pktlog_handle();
  232. if (!pl_dev) {
  233. mutex_unlock(&proc_mutex);
  234. qdf_info("Invalid pktlog handle");
  235. ASSERT(0);
  236. return -ENODEV;
  237. }
  238. ctl->data = &size;
  239. ctl->maxlen = sizeof(size);
  240. if (write) {
  241. ret = QDF_SYSCTL_PROC_DOINTVEC(ctl, write, filp, buffer,
  242. lenp, ppos);
  243. if (ret == 0)
  244. ret = pl_dev->pl_funcs->pktlog_setsize(
  245. (struct hif_opaque_softc *)scn, size);
  246. } else {
  247. size = get_pktlog_bufsize(pl_dev);
  248. ret = QDF_SYSCTL_PROC_DOINTVEC(ctl, write, filp, buffer,
  249. lenp, ppos);
  250. }
  251. ctl->data = NULL;
  252. ctl->maxlen = 0;
  253. mutex_unlock(&proc_mutex);
  254. return ret;
  255. }
  256. /* Register sysctl table */
  257. static int pktlog_sysctl_register(struct hif_opaque_softc *scn)
  258. {
  259. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  260. struct ath_pktlog_info_lnx *pl_info_lnx;
  261. char *proc_name;
  262. if (pl_dev) {
  263. pl_info_lnx = PL_INFO_LNX(pl_dev->pl_info);
  264. proc_name = pl_dev->name;
  265. } else {
  266. pl_info_lnx = PL_INFO_LNX(g_pktlog_info);
  267. proc_name = PKTLOG_PROC_SYSTEM;
  268. }
  269. /*
  270. * Setup the sysctl table for creating the following sysctl entries:
  271. * /proc/sys/PKTLOG_PROC_DIR/<adapter>/enable for enabling/disabling
  272. * pktlog
  273. * /proc/sys/PKTLOG_PROC_DIR/<adapter>/size for changing the buffer size
  274. */
  275. memset(pl_info_lnx->sysctls, 0, sizeof(pl_info_lnx->sysctls));
  276. pl_info_lnx->sysctls[0].procname = PKTLOG_PROC_DIR;
  277. pl_info_lnx->sysctls[0].mode = PKTLOG_PROCSYS_DIR_PERM;
  278. pl_info_lnx->sysctls[0].child = &pl_info_lnx->sysctls[2];
  279. /* [1] is NULL terminator */
  280. pl_info_lnx->sysctls[2].procname = proc_name;
  281. pl_info_lnx->sysctls[2].mode = PKTLOG_PROCSYS_DIR_PERM;
  282. pl_info_lnx->sysctls[2].child = &pl_info_lnx->sysctls[4];
  283. /* [3] is NULL terminator */
  284. pl_info_lnx->sysctls[4].procname = "enable";
  285. pl_info_lnx->sysctls[4].mode = PKTLOG_PROCSYS_PERM;
  286. pl_info_lnx->sysctls[4].proc_handler = ath_sysctl_pktlog_enable;
  287. pl_info_lnx->sysctls[4].extra1 = scn;
  288. pl_info_lnx->sysctls[5].procname = "size";
  289. pl_info_lnx->sysctls[5].mode = PKTLOG_PROCSYS_PERM;
  290. pl_info_lnx->sysctls[5].proc_handler = ath_sysctl_pktlog_size;
  291. pl_info_lnx->sysctls[5].extra1 = scn;
  292. pl_info_lnx->sysctls[6].procname = "options";
  293. pl_info_lnx->sysctls[6].mode = PKTLOG_PROCSYS_PERM;
  294. pl_info_lnx->sysctls[6].proc_handler = proc_dointvec;
  295. pl_info_lnx->sysctls[6].data = &pl_info_lnx->info.options;
  296. pl_info_lnx->sysctls[6].maxlen = sizeof(pl_info_lnx->info.options);
  297. pl_info_lnx->sysctls[7].procname = "sack_thr";
  298. pl_info_lnx->sysctls[7].mode = PKTLOG_PROCSYS_PERM;
  299. pl_info_lnx->sysctls[7].proc_handler = proc_dointvec;
  300. pl_info_lnx->sysctls[7].data = &pl_info_lnx->info.sack_thr;
  301. pl_info_lnx->sysctls[7].maxlen = sizeof(pl_info_lnx->info.sack_thr);
  302. pl_info_lnx->sysctls[8].procname = "tail_length";
  303. pl_info_lnx->sysctls[8].mode = PKTLOG_PROCSYS_PERM;
  304. pl_info_lnx->sysctls[8].proc_handler = proc_dointvec;
  305. pl_info_lnx->sysctls[8].data = &pl_info_lnx->info.tail_length;
  306. pl_info_lnx->sysctls[8].maxlen = sizeof(pl_info_lnx->info.tail_length);
  307. pl_info_lnx->sysctls[9].procname = "thruput_thresh";
  308. pl_info_lnx->sysctls[9].mode = PKTLOG_PROCSYS_PERM;
  309. pl_info_lnx->sysctls[9].proc_handler = proc_dointvec;
  310. pl_info_lnx->sysctls[9].data = &pl_info_lnx->info.thruput_thresh;
  311. pl_info_lnx->sysctls[9].maxlen =
  312. sizeof(pl_info_lnx->info.thruput_thresh);
  313. pl_info_lnx->sysctls[10].procname = "phyerr_thresh";
  314. pl_info_lnx->sysctls[10].mode = PKTLOG_PROCSYS_PERM;
  315. pl_info_lnx->sysctls[10].proc_handler = proc_dointvec;
  316. pl_info_lnx->sysctls[10].data = &pl_info_lnx->info.phyerr_thresh;
  317. pl_info_lnx->sysctls[10].maxlen =
  318. sizeof(pl_info_lnx->info.phyerr_thresh);
  319. pl_info_lnx->sysctls[11].procname = "per_thresh";
  320. pl_info_lnx->sysctls[11].mode = PKTLOG_PROCSYS_PERM;
  321. pl_info_lnx->sysctls[11].proc_handler = proc_dointvec;
  322. pl_info_lnx->sysctls[11].data = &pl_info_lnx->info.per_thresh;
  323. pl_info_lnx->sysctls[11].maxlen = sizeof(pl_info_lnx->info.per_thresh);
  324. pl_info_lnx->sysctls[12].procname = "trigger_interval";
  325. pl_info_lnx->sysctls[12].mode = PKTLOG_PROCSYS_PERM;
  326. pl_info_lnx->sysctls[12].proc_handler = proc_dointvec;
  327. pl_info_lnx->sysctls[12].data = &pl_info_lnx->info.trigger_interval;
  328. pl_info_lnx->sysctls[12].maxlen =
  329. sizeof(pl_info_lnx->info.trigger_interval);
  330. /* [13] is NULL terminator */
  331. /* and register everything */
  332. /* register_sysctl_table changed from 2.6.21 onwards */
  333. pl_info_lnx->sysctl_header =
  334. register_sysctl_table(pl_info_lnx->sysctls);
  335. if (!pl_info_lnx->sysctl_header) {
  336. qdf_nofl_info("%s: failed to register sysctls!", proc_name);
  337. return -EINVAL;
  338. }
  339. return 0;
  340. }
  341. /*
  342. * Initialize logging for system or adapter
  343. * Parameter scn should be NULL for system wide logging
  344. */
  345. static int pktlog_attach(struct hif_opaque_softc *scn)
  346. {
  347. struct pktlog_dev_t *pl_dev;
  348. struct ath_pktlog_info_lnx *pl_info_lnx;
  349. char *proc_name;
  350. struct proc_dir_entry *proc_entry;
  351. qdf_info("attach pktlog resources");
  352. /* Allocate pktlog dev for later use */
  353. pl_dev = get_pktlog_handle();
  354. if (pl_dev) {
  355. pl_info_lnx = kmalloc(sizeof(*pl_info_lnx), GFP_KERNEL);
  356. if (!pl_info_lnx) {
  357. QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_ERROR,
  358. "%s: Allocation failed for pl_info",
  359. __func__);
  360. goto attach_fail1;
  361. }
  362. pl_dev->pl_info = &pl_info_lnx->info;
  363. pl_dev->name = WLANDEV_BASENAME;
  364. proc_name = pl_dev->name;
  365. if (!pl_dev->pl_funcs)
  366. pl_dev->pl_funcs = &ol_pl_funcs;
  367. /*
  368. * Valid for both direct attach and offload architecture
  369. */
  370. pl_dev->pl_funcs->pktlog_init(scn);
  371. } else {
  372. qdf_err("pl_dev is NULL");
  373. return -EINVAL;
  374. }
  375. /*
  376. * initialize log info
  377. * might be good to move to pktlog_init
  378. */
  379. /* pl_dev->tgt_pktlog_alloced = false; */
  380. pl_info_lnx->proc_entry = NULL;
  381. pl_info_lnx->sysctl_header = NULL;
  382. proc_entry = proc_create_data(proc_name, PKTLOG_PROC_PERM,
  383. g_pktlog_pde, &pktlog_fops,
  384. &pl_info_lnx->info);
  385. if (!proc_entry) {
  386. qdf_info(PKTLOG_TAG "create_proc_entry failed for %s", proc_name);
  387. goto attach_fail1;
  388. }
  389. pl_info_lnx->proc_entry = proc_entry;
  390. if (pktlog_sysctl_register(scn)) {
  391. qdf_nofl_info(PKTLOG_TAG "sysctl register failed for %s",
  392. proc_name);
  393. goto attach_fail2;
  394. }
  395. return 0;
  396. attach_fail2:
  397. remove_proc_entry(proc_name, g_pktlog_pde);
  398. attach_fail1:
  399. if (pl_dev)
  400. kfree(pl_dev->pl_info);
  401. return -EINVAL;
  402. }
  403. static void pktlog_sysctl_unregister(struct pktlog_dev_t *pl_dev)
  404. {
  405. struct ath_pktlog_info_lnx *pl_info_lnx;
  406. if (!pl_dev) {
  407. qdf_info("Invalid pktlog context");
  408. ASSERT(0);
  409. return;
  410. }
  411. pl_info_lnx = (pl_dev) ? PL_INFO_LNX(pl_dev->pl_info) :
  412. PL_INFO_LNX(g_pktlog_info);
  413. if (pl_info_lnx->sysctl_header) {
  414. unregister_sysctl_table(pl_info_lnx->sysctl_header);
  415. pl_info_lnx->sysctl_header = NULL;
  416. }
  417. }
  418. static void pktlog_detach(struct hif_opaque_softc *scn)
  419. {
  420. struct ath_pktlog_info *pl_info;
  421. struct pktlog_dev_t *pl_dev = get_pktlog_handle();
  422. qdf_info("detach pktlog resources");
  423. if (!pl_dev) {
  424. qdf_info("Invalid pktlog context");
  425. ASSERT(0);
  426. return;
  427. }
  428. pl_info = pl_dev->pl_info;
  429. if (!pl_info) {
  430. qdf_print("Invalid pktlog handle");
  431. ASSERT(0);
  432. return;
  433. }
  434. mutex_lock(&pl_info->pktlog_mutex);
  435. remove_proc_entry(WLANDEV_BASENAME, g_pktlog_pde);
  436. pktlog_sysctl_unregister(pl_dev);
  437. qdf_spin_lock_bh(&pl_info->log_lock);
  438. if (pl_info->buf) {
  439. pktlog_release_buf(scn);
  440. pl_dev->tgt_pktlog_alloced = false;
  441. }
  442. qdf_spin_unlock_bh(&pl_info->log_lock);
  443. mutex_unlock(&pl_info->pktlog_mutex);
  444. pktlog_cleanup(pl_info);
  445. if (pl_dev) {
  446. kfree(pl_info);
  447. pl_dev->pl_info = NULL;
  448. }
  449. }
  450. static int __pktlog_open(struct inode *i, struct file *f)
  451. {
  452. struct hif_opaque_softc *scn;
  453. struct pktlog_dev_t *pl_dev;
  454. struct ath_pktlog_info *pl_info;
  455. struct ath_pktlog_info_lnx *pl_info_lnx;
  456. int ret = 0;
  457. PKTLOG_MOD_INC_USE_COUNT;
  458. scn = cds_get_context(QDF_MODULE_ID_HIF);
  459. if (!scn) {
  460. qdf_print("Invalid scn context");
  461. ASSERT(0);
  462. return -EINVAL;
  463. }
  464. pl_dev = get_pktlog_handle();
  465. if (!pl_dev) {
  466. qdf_print("Invalid pktlog handle");
  467. ASSERT(0);
  468. return -ENODEV;
  469. }
  470. pl_info = pl_dev->pl_info;
  471. if (!pl_info) {
  472. qdf_err("pl_info NULL");
  473. return -EINVAL;
  474. }
  475. mutex_lock(&pl_info->pktlog_mutex);
  476. pl_info_lnx = (pl_dev) ? PL_INFO_LNX(pl_dev->pl_info) :
  477. PL_INFO_LNX(g_pktlog_info);
  478. if (!pl_info_lnx->sysctl_header) {
  479. mutex_unlock(&pl_info->pktlog_mutex);
  480. qdf_print("pktlog sysctl is unergistered");
  481. ASSERT(0);
  482. return -EINVAL;
  483. }
  484. if (pl_info->curr_pkt_state != PKTLOG_OPR_NOT_IN_PROGRESS) {
  485. mutex_unlock(&pl_info->pktlog_mutex);
  486. qdf_print("plinfo state (%d) != PKTLOG_OPR_NOT_IN_PROGRESS",
  487. pl_info->curr_pkt_state);
  488. return -EBUSY;
  489. }
  490. pl_info->curr_pkt_state = PKTLOG_OPR_IN_PROGRESS_READ_START;
  491. pl_info->init_saved_state = pl_info->log_state;
  492. if (!pl_info->log_state) {
  493. /* Pktlog is already disabled.
  494. * Proceed to read directly.
  495. */
  496. pl_info->curr_pkt_state =
  497. PKTLOG_OPR_IN_PROGRESS_READ_START_PKTLOG_DISABLED;
  498. mutex_unlock(&pl_info->pktlog_mutex);
  499. return ret;
  500. }
  501. /* Disbable the pktlog internally. */
  502. ret = pl_dev->pl_funcs->pktlog_disable(scn);
  503. pl_info->log_state = 0;
  504. pl_info->curr_pkt_state =
  505. PKTLOG_OPR_IN_PROGRESS_READ_START_PKTLOG_DISABLED;
  506. mutex_unlock(&pl_info->pktlog_mutex);
  507. return ret;
  508. }
  509. static int pktlog_open(struct inode *i, struct file *f)
  510. {
  511. struct qdf_op_sync *op_sync;
  512. int errno;
  513. errno = qdf_op_protect(&op_sync);
  514. if (errno)
  515. return errno;
  516. errno = __pktlog_open(i, f);
  517. qdf_op_unprotect(op_sync);
  518. return errno;
  519. }
  520. static int __pktlog_release(struct inode *i, struct file *f)
  521. {
  522. struct hif_opaque_softc *scn;
  523. struct pktlog_dev_t *pl_dev;
  524. struct ath_pktlog_info *pl_info;
  525. struct ath_pktlog_info_lnx *pl_info_lnx;
  526. int ret = 0;
  527. PKTLOG_MOD_DEC_USE_COUNT;
  528. scn = cds_get_context(QDF_MODULE_ID_HIF);
  529. if (!scn) {
  530. qdf_print("Invalid scn context");
  531. ASSERT(0);
  532. return -EINVAL;
  533. }
  534. pl_dev = get_pktlog_handle();
  535. if (!pl_dev) {
  536. qdf_print("Invalid pktlog handle");
  537. ASSERT(0);
  538. return -ENODEV;
  539. }
  540. pl_info = pl_dev->pl_info;
  541. if (!pl_info) {
  542. qdf_print("Invalid pktlog info");
  543. ASSERT(0);
  544. return -EINVAL;
  545. }
  546. mutex_lock(&pl_info->pktlog_mutex);
  547. pl_info_lnx = (pl_dev) ? PL_INFO_LNX(pl_dev->pl_info) :
  548. PL_INFO_LNX(g_pktlog_info);
  549. if (!pl_info_lnx->sysctl_header) {
  550. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  551. mutex_unlock(&pl_info->pktlog_mutex);
  552. qdf_print("pktlog sysctl is unergistered");
  553. ASSERT(0);
  554. return -EINVAL;
  555. }
  556. pl_info->curr_pkt_state = PKTLOG_OPR_IN_PROGRESS_READ_COMPLETE;
  557. /*clear pktlog buffer.*/
  558. pktlog_clearbuff(scn, true);
  559. pl_info->log_state = pl_info->init_saved_state;
  560. pl_info->init_saved_state = 0;
  561. /*Enable pktlog again*/
  562. ret = __pktlog_enable(
  563. (struct hif_opaque_softc *)scn, pl_info->log_state,
  564. cds_is_packet_log_enabled(), 0, 1);
  565. pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
  566. mutex_unlock(&pl_info->pktlog_mutex);
  567. if (ret != 0)
  568. qdf_print("pktlog cannot be enabled. ret value %d", ret);
  569. return ret;
  570. }
  571. static int pktlog_release(struct inode *i, struct file *f)
  572. {
  573. struct qdf_op_sync *op_sync;
  574. int errno;
  575. errno = qdf_op_protect(&op_sync);
  576. if (errno)
  577. return errno;
  578. errno = __pktlog_release(i, f);
  579. qdf_op_unprotect(op_sync);
  580. return errno;
  581. }
  582. #ifndef MIN
  583. #define MIN(a, b) (((a) < (b)) ? (a) : (b))
  584. #endif
  585. /**
  586. * pktlog_read_proc_entry() - This function is used to read data from the
  587. * proc entry into the readers buffer
  588. * @buf: Readers buffer
  589. * @nbytes: Number of bytes to read
  590. * @ppos: Offset within the drivers buffer
  591. * @pl_info: Packet log information pointer
  592. * @read_complete: Boolean value indication whether read is complete
  593. *
  594. * This function is used to read data from the proc entry into the readers
  595. * buffer. Its functionality is similar to 'pktlog_read' which does
  596. * copy to user to the user space buffer
  597. *
  598. * Return: Number of bytes read from the buffer
  599. *
  600. */
  601. ssize_t
  602. pktlog_read_proc_entry(char *buf, size_t nbytes, loff_t *ppos,
  603. struct ath_pktlog_info *pl_info, bool *read_complete)
  604. {
  605. size_t bufhdr_size;
  606. size_t count = 0, ret_val = 0;
  607. int rem_len;
  608. int start_offset, end_offset;
  609. int fold_offset, ppos_data, cur_rd_offset, cur_wr_offset;
  610. struct ath_pktlog_buf *log_buf;
  611. qdf_spin_lock_bh(&pl_info->log_lock);
  612. log_buf = pl_info->buf;
  613. *read_complete = false;
  614. if (!log_buf) {
  615. *read_complete = true;
  616. qdf_spin_unlock_bh(&pl_info->log_lock);
  617. return 0;
  618. }
  619. if (*ppos == 0 && pl_info->log_state) {
  620. pl_info->saved_state = pl_info->log_state;
  621. pl_info->log_state = 0;
  622. }
  623. bufhdr_size = sizeof(log_buf->bufhdr);
  624. /* copy valid log entries from circular buffer into user space */
  625. rem_len = nbytes;
  626. count = 0;
  627. if (*ppos < bufhdr_size) {
  628. count = MIN((bufhdr_size - *ppos), rem_len);
  629. qdf_mem_copy(buf, ((char *)&log_buf->bufhdr) + *ppos,
  630. count);
  631. rem_len -= count;
  632. ret_val += count;
  633. }
  634. start_offset = log_buf->rd_offset;
  635. cur_wr_offset = log_buf->wr_offset;
  636. if ((rem_len == 0) || (start_offset < 0))
  637. goto rd_done;
  638. fold_offset = -1;
  639. cur_rd_offset = start_offset;
  640. /* Find the last offset and fold-offset if the buffer is folded */
  641. do {
  642. struct ath_pktlog_hdr *log_hdr;
  643. int log_data_offset;
  644. log_hdr = (struct ath_pktlog_hdr *) (log_buf->log_data +
  645. cur_rd_offset);
  646. log_data_offset = cur_rd_offset + sizeof(struct ath_pktlog_hdr);
  647. if ((fold_offset == -1)
  648. && ((pl_info->buf_size - log_data_offset)
  649. <= log_hdr->size))
  650. fold_offset = log_data_offset - 1;
  651. PKTLOG_MOV_RD_IDX(cur_rd_offset, log_buf, pl_info->buf_size);
  652. if ((fold_offset == -1) && (cur_rd_offset == 0)
  653. && (cur_rd_offset != cur_wr_offset))
  654. fold_offset = log_data_offset + log_hdr->size - 1;
  655. end_offset = log_data_offset + log_hdr->size - 1;
  656. } while (cur_rd_offset != cur_wr_offset);
  657. ppos_data = *ppos + ret_val - bufhdr_size + start_offset;
  658. if (fold_offset == -1) {
  659. if (ppos_data > end_offset)
  660. goto rd_done;
  661. count = MIN(rem_len, (end_offset - ppos_data + 1));
  662. qdf_mem_copy(buf + ret_val,
  663. log_buf->log_data + ppos_data,
  664. count);
  665. ret_val += count;
  666. rem_len -= count;
  667. } else {
  668. if (ppos_data <= fold_offset) {
  669. count = MIN(rem_len, (fold_offset - ppos_data + 1));
  670. qdf_mem_copy(buf + ret_val,
  671. log_buf->log_data + ppos_data,
  672. count);
  673. ret_val += count;
  674. rem_len -= count;
  675. }
  676. if (rem_len == 0)
  677. goto rd_done;
  678. ppos_data =
  679. *ppos + ret_val - (bufhdr_size +
  680. (fold_offset - start_offset + 1));
  681. if (ppos_data <= end_offset) {
  682. count = MIN(rem_len, (end_offset - ppos_data + 1));
  683. qdf_mem_copy(buf + ret_val,
  684. log_buf->log_data + ppos_data,
  685. count);
  686. ret_val += count;
  687. rem_len -= count;
  688. }
  689. }
  690. rd_done:
  691. if ((ret_val < nbytes) && pl_info->saved_state) {
  692. pl_info->log_state = pl_info->saved_state;
  693. pl_info->saved_state = 0;
  694. }
  695. *ppos += ret_val;
  696. if (ret_val == 0) {
  697. /* Write pointer might have been updated during the read.
  698. * So, if some data is written into, lets not reset the pointers
  699. * We can continue to read from the offset position
  700. */
  701. if (cur_wr_offset != log_buf->wr_offset) {
  702. *read_complete = false;
  703. } else {
  704. pl_info->buf->rd_offset = -1;
  705. pl_info->buf->wr_offset = 0;
  706. pl_info->buf->bytes_written = 0;
  707. pl_info->buf->offset = PKTLOG_READ_OFFSET;
  708. *read_complete = true;
  709. }
  710. }
  711. qdf_spin_unlock_bh(&pl_info->log_lock);
  712. return ret_val;
  713. }
  714. static ssize_t
  715. __pktlog_read(struct file *file, char *buf, size_t nbytes, loff_t *ppos)
  716. {
  717. size_t bufhdr_size;
  718. size_t count = 0, ret_val = 0;
  719. int rem_len;
  720. int start_offset, end_offset;
  721. int fold_offset, ppos_data, cur_rd_offset;
  722. struct ath_pktlog_info *pl_info;
  723. struct ath_pktlog_buf *log_buf;
  724. pl_info = PDE_DATA(file->f_path.dentry->d_inode);
  725. if (!pl_info)
  726. return 0;
  727. qdf_spin_lock_bh(&pl_info->log_lock);
  728. log_buf = pl_info->buf;
  729. if (!log_buf) {
  730. qdf_spin_unlock_bh(&pl_info->log_lock);
  731. return 0;
  732. }
  733. if (pl_info->log_state) {
  734. /* Read is not allowed when write is going on
  735. * When issuing cat command, ensure to send
  736. * pktlog disable command first.
  737. */
  738. qdf_spin_unlock_bh(&pl_info->log_lock);
  739. return -EINVAL;
  740. }
  741. if (*ppos == 0 && pl_info->log_state) {
  742. pl_info->saved_state = pl_info->log_state;
  743. pl_info->log_state = 0;
  744. }
  745. bufhdr_size = sizeof(log_buf->bufhdr);
  746. /* copy valid log entries from circular buffer into user space */
  747. rem_len = nbytes;
  748. count = 0;
  749. if (*ppos < bufhdr_size) {
  750. count = QDF_MIN((bufhdr_size - *ppos), rem_len);
  751. qdf_spin_unlock_bh(&pl_info->log_lock);
  752. if (copy_to_user(buf, ((char *)&log_buf->bufhdr) + *ppos,
  753. count)) {
  754. return -EFAULT;
  755. }
  756. rem_len -= count;
  757. ret_val += count;
  758. qdf_spin_lock_bh(&pl_info->log_lock);
  759. }
  760. start_offset = log_buf->rd_offset;
  761. if ((rem_len == 0) || (start_offset < 0))
  762. goto rd_done;
  763. fold_offset = -1;
  764. cur_rd_offset = start_offset;
  765. /* Find the last offset and fold-offset if the buffer is folded */
  766. do {
  767. struct ath_pktlog_hdr *log_hdr;
  768. int log_data_offset;
  769. log_hdr = (struct ath_pktlog_hdr *)(log_buf->log_data +
  770. cur_rd_offset);
  771. log_data_offset = cur_rd_offset + sizeof(struct ath_pktlog_hdr);
  772. if ((fold_offset == -1)
  773. && ((pl_info->buf_size - log_data_offset)
  774. <= log_hdr->size))
  775. fold_offset = log_data_offset - 1;
  776. PKTLOG_MOV_RD_IDX(cur_rd_offset, log_buf, pl_info->buf_size);
  777. if ((fold_offset == -1) && (cur_rd_offset == 0)
  778. && (cur_rd_offset != log_buf->wr_offset))
  779. fold_offset = log_data_offset + log_hdr->size - 1;
  780. end_offset = log_data_offset + log_hdr->size - 1;
  781. } while (cur_rd_offset != log_buf->wr_offset);
  782. ppos_data = *ppos + ret_val - bufhdr_size + start_offset;
  783. if (fold_offset == -1) {
  784. if (ppos_data > end_offset)
  785. goto rd_done;
  786. count = QDF_MIN(rem_len, (end_offset - ppos_data + 1));
  787. qdf_spin_unlock_bh(&pl_info->log_lock);
  788. if (copy_to_user(buf + ret_val,
  789. log_buf->log_data + ppos_data, count)) {
  790. return -EFAULT;
  791. }
  792. ret_val += count;
  793. rem_len -= count;
  794. qdf_spin_lock_bh(&pl_info->log_lock);
  795. } else {
  796. if (ppos_data <= fold_offset) {
  797. count = QDF_MIN(rem_len, (fold_offset - ppos_data + 1));
  798. qdf_spin_unlock_bh(&pl_info->log_lock);
  799. if (copy_to_user(buf + ret_val,
  800. log_buf->log_data + ppos_data,
  801. count)) {
  802. return -EFAULT;
  803. }
  804. ret_val += count;
  805. rem_len -= count;
  806. qdf_spin_lock_bh(&pl_info->log_lock);
  807. }
  808. if (rem_len == 0)
  809. goto rd_done;
  810. ppos_data =
  811. *ppos + ret_val - (bufhdr_size +
  812. (fold_offset - start_offset + 1));
  813. if (ppos_data <= end_offset) {
  814. count = QDF_MIN(rem_len, (end_offset - ppos_data + 1));
  815. qdf_spin_unlock_bh(&pl_info->log_lock);
  816. if (copy_to_user(buf + ret_val,
  817. log_buf->log_data + ppos_data,
  818. count)) {
  819. return -EFAULT;
  820. }
  821. ret_val += count;
  822. rem_len -= count;
  823. qdf_spin_lock_bh(&pl_info->log_lock);
  824. }
  825. }
  826. rd_done:
  827. if ((ret_val < nbytes) && pl_info->saved_state) {
  828. pl_info->log_state = pl_info->saved_state;
  829. pl_info->saved_state = 0;
  830. }
  831. *ppos += ret_val;
  832. qdf_spin_unlock_bh(&pl_info->log_lock);
  833. return ret_val;
  834. }
  835. static ssize_t
  836. pktlog_read(struct file *file, char *buf, size_t nbytes, loff_t *ppos)
  837. {
  838. struct ath_pktlog_info *info = PDE_DATA(file->f_path.dentry->d_inode);
  839. struct qdf_op_sync *op_sync;
  840. ssize_t err_size;
  841. if (!info)
  842. return 0;
  843. err_size = qdf_op_protect(&op_sync);
  844. if (err_size)
  845. return err_size;
  846. mutex_lock(&info->pktlog_mutex);
  847. err_size = __pktlog_read(file, buf, nbytes, ppos);
  848. mutex_unlock(&info->pktlog_mutex);
  849. qdf_op_unprotect(op_sync);
  850. return err_size;
  851. }
  852. int pktlogmod_init(void *context)
  853. {
  854. int ret;
  855. qdf_info("Initialize pkt_log module");
  856. /* create the proc directory entry */
  857. g_pktlog_pde = proc_mkdir(PKTLOG_PROC_DIR, NULL);
  858. if (!g_pktlog_pde) {
  859. qdf_info(PKTLOG_TAG "proc_mkdir failed");
  860. return -EPERM;
  861. }
  862. /* Attach packet log */
  863. ret = pktlog_attach((struct hif_opaque_softc *)context);
  864. /* If packet log init failed */
  865. if (ret) {
  866. qdf_err("pktlog_attach failed");
  867. goto attach_fail;
  868. }
  869. return ret;
  870. attach_fail:
  871. remove_proc_entry(PKTLOG_PROC_DIR, NULL);
  872. g_pktlog_pde = NULL;
  873. return ret;
  874. }
  875. void pktlogmod_exit(void *context)
  876. {
  877. qdf_info("pkt_log module cleanup");
  878. if (!g_pktlog_pde) {
  879. qdf_err("g_pktlog_pde is NULL");
  880. return;
  881. }
  882. pktlog_detach((struct hif_opaque_softc *)context);
  883. /*
  884. * pdev kill needs to be implemented
  885. */
  886. remove_proc_entry(PKTLOG_PROC_DIR, NULL);
  887. g_pktlog_pde = NULL;
  888. }
  889. #endif