linux_ac.c 26 KB

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