linux_ac.c 26 KB

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