123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896 |
- /*
- * Copyright (c) 2012-2017 The Linux Foundation. All rights reserved.
- *
- * Previously licensed under the ISC license by Qualcomm Atheros, Inc.
- *
- *
- * Permission to use, copy, modify, and/or distribute this software for
- * any purpose with or without fee is hereby granted, provided that the
- * above copyright notice and this permission notice appear in all
- * copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
- * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
- * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
- * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
- * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
- * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
- * PERFORMANCE OF THIS SOFTWARE.
- */
- /*
- * This file was originally distributed by Qualcomm Atheros, Inc.
- * under proprietary terms before Copyright ownership was assigned
- * to the Linux Foundation.
- */
- /*
- *
- * Permission to use, copy, modify, and/or distribute this software for any
- * purpose with or without fee is hereby granted, provided that the above
- * copyright notice and this permission notice appear in all copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
- * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
- * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
- * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
- * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
- * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
- */
- #ifndef REMOVE_PKT_LOG
- #include "qdf_mem.h"
- #include "athdefs.h"
- #include "pktlog_ac_i.h"
- #include "cds_api.h"
- #include "wma_types.h"
- #include "htc.h"
- wdi_event_subscribe PKTLOG_TX_SUBSCRIBER;
- wdi_event_subscribe PKTLOG_RX_SUBSCRIBER;
- wdi_event_subscribe PKTLOG_RX_REMOTE_SUBSCRIBER;
- wdi_event_subscribe PKTLOG_RCFIND_SUBSCRIBER;
- wdi_event_subscribe PKTLOG_RCUPDATE_SUBSCRIBER;
- wdi_event_subscribe PKTLOG_SW_EVENT_SUBSCRIBER;
- struct ol_pl_arch_dep_funcs ol_pl_funcs = {
- .pktlog_init = pktlog_init,
- .pktlog_enable = pktlog_enable,
- .pktlog_setsize = pktlog_setsize,
- .pktlog_disable = pktlog_disable, /* valid for f/w disable */
- };
- struct ol_pktlog_dev_t ol_pl_dev = {
- .pl_funcs = &ol_pl_funcs,
- };
- void ol_pl_sethandle(ol_pktlog_dev_handle *pl_handle,
- struct hif_opaque_softc *scn)
- {
- ol_pl_dev.scn = (ol_ath_generic_softc_handle) scn;
- *pl_handle = &ol_pl_dev;
- }
- static A_STATUS pktlog_wma_post_msg(WMI_PKTLOG_EVENT event_types,
- WMI_CMD_ID cmd_id, bool ini_triggered,
- uint8_t user_triggered)
- {
- struct scheduler_msg msg = { 0 };
- QDF_STATUS status;
- struct ath_pktlog_wmi_params *param;
- param = qdf_mem_malloc(sizeof(struct ath_pktlog_wmi_params));
- if (!param)
- return A_NO_MEMORY;
- param->cmd_id = cmd_id;
- param->pktlog_event = event_types;
- param->ini_triggered = ini_triggered;
- param->user_triggered = user_triggered;
- msg.type = WMA_PKTLOG_ENABLE_REQ;
- msg.bodyptr = param;
- msg.bodyval = 0;
- status = scheduler_post_msg(QDF_MODULE_ID_WMA, &msg);
- if (status != QDF_STATUS_SUCCESS) {
- qdf_mem_free(param);
- return A_ERROR;
- }
- return A_OK;
- }
- static inline A_STATUS
- pktlog_enable_tgt(struct hif_opaque_softc *_scn, uint32_t log_state,
- bool ini_triggered, uint8_t user_triggered)
- {
- uint32_t types = 0;
- if (log_state & ATH_PKTLOG_TX)
- types |= WMI_PKTLOG_EVENT_TX;
- if (log_state & ATH_PKTLOG_RX)
- types |= WMI_PKTLOG_EVENT_RX;
- if (log_state & ATH_PKTLOG_RCFIND)
- types |= WMI_PKTLOG_EVENT_RCF;
- if (log_state & ATH_PKTLOG_RCUPDATE)
- types |= WMI_PKTLOG_EVENT_RCU;
- if (log_state & ATH_PKTLOG_SW_EVENT)
- types |= WMI_PKTLOG_EVENT_SW;
- return pktlog_wma_post_msg(types, WMI_PDEV_PKTLOG_ENABLE_CMDID,
- ini_triggered, user_triggered);
- }
- static inline A_STATUS
- wdi_pktlog_subscribe(struct ol_txrx_pdev_t *txrx_pdev, int32_t log_state)
- {
- if (!txrx_pdev) {
- printk("Invalid pdev in %s\n", __func__);
- return A_ERROR;
- }
- if (log_state & ATH_PKTLOG_TX) {
- if (wdi_event_sub(txrx_pdev,
- &PKTLOG_TX_SUBSCRIBER, WDI_EVENT_TX_STATUS)) {
- return A_ERROR;
- }
- }
- if (log_state & ATH_PKTLOG_RX) {
- if (wdi_event_sub(txrx_pdev,
- &PKTLOG_RX_SUBSCRIBER, WDI_EVENT_RX_DESC)) {
- return A_ERROR;
- }
- if (wdi_event_sub(txrx_pdev,
- &PKTLOG_RX_REMOTE_SUBSCRIBER,
- WDI_EVENT_RX_DESC_REMOTE)) {
- return A_ERROR;
- }
- }
- if (log_state & ATH_PKTLOG_RCFIND) {
- if (wdi_event_sub(txrx_pdev,
- &PKTLOG_RCFIND_SUBSCRIBER,
- WDI_EVENT_RATE_FIND)) {
- return A_ERROR;
- }
- }
- if (log_state & ATH_PKTLOG_RCUPDATE) {
- if (wdi_event_sub(txrx_pdev,
- &PKTLOG_RCUPDATE_SUBSCRIBER,
- WDI_EVENT_RATE_UPDATE)) {
- return A_ERROR;
- }
- }
- if (log_state & ATH_PKTLOG_SW_EVENT) {
- if (wdi_event_sub(txrx_pdev,
- &PKTLOG_SW_EVENT_SUBSCRIBER,
- WDI_EVENT_SW_EVENT)) {
- return A_ERROR;
- }
- }
- return A_OK;
- }
- void pktlog_callback(void *pdev, enum WDI_EVENT event, void *log_data)
- {
- switch (event) {
- case WDI_EVENT_TX_STATUS:
- {
- /*
- * process TX message
- */
- if (process_tx_info(pdev, log_data)) {
- printk("Unable to process TX info\n");
- return;
- }
- break;
- }
- case WDI_EVENT_RX_DESC:
- {
- /*
- * process RX message for local frames
- */
- if (process_rx_info(pdev, log_data)) {
- printk("Unable to process RX info\n");
- return;
- }
- break;
- }
- case WDI_EVENT_RX_DESC_REMOTE:
- {
- /*
- * process RX message for remote frames
- */
- if (process_rx_info_remote(pdev, log_data)) {
- printk("Unable to process RX info\n");
- return;
- }
- break;
- }
- case WDI_EVENT_RATE_FIND:
- {
- /*
- * process RATE_FIND message
- */
- if (process_rate_find(pdev, log_data)) {
- printk("Unable to process RC_FIND info\n");
- return;
- }
- break;
- }
- case WDI_EVENT_RATE_UPDATE:
- {
- /*
- * process RATE_UPDATE message
- */
- if (process_rate_update(pdev, log_data)) {
- printk("Unable to process RC_UPDATE\n");
- return;
- }
- break;
- }
- case WDI_EVENT_SW_EVENT:
- {
- /*
- * process SW EVENT message
- */
- if (process_sw_event(pdev, log_data)) {
- printk("Unable to process SW_EVENT\n");
- return;
- }
- break;
- }
- default:
- break;
- }
- }
- A_STATUS
- wdi_pktlog_unsubscribe(struct ol_txrx_pdev_t *txrx_pdev, uint32_t log_state)
- {
- if (log_state & ATH_PKTLOG_TX) {
- if (wdi_event_unsub(txrx_pdev,
- &PKTLOG_TX_SUBSCRIBER,
- WDI_EVENT_TX_STATUS)) {
- return A_ERROR;
- }
- }
- if (log_state & ATH_PKTLOG_RX) {
- if (wdi_event_unsub(txrx_pdev,
- &PKTLOG_RX_SUBSCRIBER, WDI_EVENT_RX_DESC)) {
- return A_ERROR;
- }
- if (wdi_event_unsub(txrx_pdev,
- &PKTLOG_RX_REMOTE_SUBSCRIBER,
- WDI_EVENT_RX_DESC_REMOTE)) {
- return A_ERROR;
- }
- }
- if (log_state & ATH_PKTLOG_RCFIND) {
- if (wdi_event_unsub(txrx_pdev,
- &PKTLOG_RCFIND_SUBSCRIBER,
- WDI_EVENT_RATE_FIND)) {
- return A_ERROR;
- }
- }
- if (log_state & ATH_PKTLOG_RCUPDATE) {
- if (wdi_event_unsub(txrx_pdev,
- &PKTLOG_RCUPDATE_SUBSCRIBER,
- WDI_EVENT_RATE_UPDATE)) {
- return A_ERROR;
- }
- }
- if (log_state & ATH_PKTLOG_RCUPDATE) {
- if (wdi_event_unsub(txrx_pdev,
- &PKTLOG_SW_EVENT_SUBSCRIBER,
- WDI_EVENT_SW_EVENT)) {
- return A_ERROR;
- }
- }
- return A_OK;
- }
- int pktlog_disable(struct hif_opaque_softc *scn)
- {
- struct ol_txrx_pdev_t *txrx_pdev =
- cds_get_context(QDF_MODULE_ID_TXRX);
- struct ol_pktlog_dev_t *pl_dev;
- struct ath_pktlog_info *pl_info;
- uint8_t save_pktlog_state;
- if (txrx_pdev == NULL ||
- txrx_pdev->pl_dev == NULL ||
- txrx_pdev->pl_dev->pl_info == NULL)
- return -EFAULT;
- pl_dev = txrx_pdev->pl_dev;
- pl_info = pl_dev->pl_info;
- if (pl_info->curr_pkt_state == PKTLOG_OPR_IN_PROGRESS ||
- pl_info->curr_pkt_state ==
- PKTLOG_OPR_IN_PROGRESS_READ_START_PKTLOG_DISABLED ||
- pl_info->curr_pkt_state == PKTLOG_OPR_IN_PROGRESS_READ_COMPLETE ||
- pl_info->curr_pkt_state ==
- PKTLOG_OPR_IN_PROGRESS_CLEARBUFF_COMPLETE)
- return -EBUSY;
- save_pktlog_state = pl_info->curr_pkt_state;
- pl_info->curr_pkt_state = PKTLOG_OPR_IN_PROGRESS;
- if (pktlog_wma_post_msg(0, WMI_PDEV_PKTLOG_DISABLE_CMDID, 0, 0)) {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- printk("Failed to disable pktlog in target\n");
- return -EINVAL;
- }
- if (pl_dev->is_pktlog_cb_subscribed &&
- wdi_pktlog_unsubscribe(txrx_pdev, pl_info->log_state)) {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- printk("Cannot unsubscribe pktlog from the WDI\n");
- return -EINVAL;
- }
- pl_dev->is_pktlog_cb_subscribed = false;
- pl_dev->is_pktlog_cb_subscribed = false;
- if (save_pktlog_state == PKTLOG_OPR_IN_PROGRESS_READ_START)
- pl_info->curr_pkt_state =
- PKTLOG_OPR_IN_PROGRESS_READ_START_PKTLOG_DISABLED;
- else
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- return 0;
- }
- void pktlog_init(struct hif_opaque_softc *scn)
- {
- struct ath_pktlog_info *pl_info;
- ol_txrx_pdev_handle pdev_txrx_handle;
- pdev_txrx_handle = cds_get_context(QDF_MODULE_ID_TXRX);
- if (pdev_txrx_handle == NULL ||
- pdev_txrx_handle->pl_dev == NULL ||
- pdev_txrx_handle->pl_dev->pl_info == NULL)
- return;
- pl_info = pdev_txrx_handle->pl_dev->pl_info;
- OS_MEMZERO(pl_info, sizeof(*pl_info));
- PKTLOG_LOCK_INIT(pl_info);
- mutex_init(&pl_info->pktlog_mutex);
- pl_info->buf_size = PKTLOG_DEFAULT_BUFSIZE;
- pl_info->buf = NULL;
- pl_info->log_state = 0;
- pl_info->init_saved_state = 0;
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- pl_info->sack_thr = PKTLOG_DEFAULT_SACK_THR;
- pl_info->tail_length = PKTLOG_DEFAULT_TAIL_LENGTH;
- pl_info->thruput_thresh = PKTLOG_DEFAULT_THRUPUT_THRESH;
- pl_info->per_thresh = PKTLOG_DEFAULT_PER_THRESH;
- pl_info->phyerr_thresh = PKTLOG_DEFAULT_PHYERR_THRESH;
- pl_info->trigger_interval = PKTLOG_DEFAULT_TRIGGER_INTERVAL;
- pl_info->pktlen = 0;
- pl_info->start_time_thruput = 0;
- pl_info->start_time_per = 0;
- pdev_txrx_handle->pl_dev->vendor_cmd_send = false;
- PKTLOG_TX_SUBSCRIBER.callback = pktlog_callback;
- PKTLOG_RX_SUBSCRIBER.callback = pktlog_callback;
- PKTLOG_RX_REMOTE_SUBSCRIBER.callback = pktlog_callback;
- PKTLOG_RCFIND_SUBSCRIBER.callback = pktlog_callback;
- PKTLOG_RCUPDATE_SUBSCRIBER.callback = pktlog_callback;
- PKTLOG_SW_EVENT_SUBSCRIBER.callback = pktlog_callback;
- }
- static int __pktlog_enable(struct hif_opaque_softc *scn, int32_t log_state,
- bool ini_triggered, uint8_t user_triggered,
- uint32_t is_iwpriv_command)
- {
- struct ol_pktlog_dev_t *pl_dev;
- struct ath_pktlog_info *pl_info;
- struct ol_txrx_pdev_t *txrx_pdev;
- int error;
- if (!scn) {
- printk("%s: Invalid scn context\n", __func__);
- ASSERT(0);
- return -EINVAL;
- }
- txrx_pdev = cds_get_context(QDF_MODULE_ID_TXRX);
- if (!txrx_pdev) {
- printk("%s: Invalid txrx_pdev context\n", __func__);
- ASSERT(0);
- return -EINVAL;
- }
- pl_dev = txrx_pdev->pl_dev;
- if (!pl_dev) {
- printk("%s: Invalid pktlog context\n", __func__);
- ASSERT(0);
- return -EINVAL;
- }
- pl_info = pl_dev->pl_info;
- if (!pl_info)
- return 0;
- if (pl_info->curr_pkt_state < PKTLOG_OPR_IN_PROGRESS_CLEARBUFF_COMPLETE)
- return -EBUSY;
- pl_info->curr_pkt_state = PKTLOG_OPR_IN_PROGRESS;
- /* is_iwpriv_command : 0 indicates its a vendor command
- * log_state: 0 indicates pktlog disable command
- * vendor_cmd_send flag; false means no vendor pktlog enable
- * command was sent previously
- */
- if (is_iwpriv_command == 0 && log_state == 0 &&
- pl_dev->vendor_cmd_send == false) {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- return 0;
- }
- if (!pl_dev->tgt_pktlog_alloced) {
- if (pl_info->buf == NULL) {
- error = pktlog_alloc_buf(scn);
- if (error != 0) {
- pl_info->curr_pkt_state =
- PKTLOG_OPR_NOT_IN_PROGRESS;
- return error;
- }
- if (!pl_info->buf) {
- pl_info->curr_pkt_state =
- PKTLOG_OPR_NOT_IN_PROGRESS;
- printk("%s: pktlog buf alloc failed\n",
- __func__);
- ASSERT(0);
- return -ENOMEM;
- }
- }
- spin_lock_bh(&pl_info->log_lock);
- pl_info->buf->bufhdr.version = CUR_PKTLOG_VER;
- pl_info->buf->bufhdr.magic_num = PKTLOG_MAGIC_NUM;
- pl_info->buf->wr_offset = 0;
- pl_info->buf->rd_offset = -1;
- /* These below variables are used by per packet stats*/
- pl_info->buf->bytes_written = 0;
- pl_info->buf->msg_index = 1;
- pl_info->buf->offset = PKTLOG_READ_OFFSET;
- spin_unlock_bh(&pl_info->log_lock);
- pl_info->start_time_thruput = os_get_timestamp();
- pl_info->start_time_per = pl_info->start_time_thruput;
- pl_dev->tgt_pktlog_alloced = true;
- }
- if (log_state != 0) {
- /* WDI subscribe */
- if ((!pl_dev->is_pktlog_cb_subscribed) &&
- wdi_pktlog_subscribe(txrx_pdev, log_state)) {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- printk("Unable to subscribe to the WDI %s\n", __func__);
- return -EINVAL;
- }
- pl_dev->is_pktlog_cb_subscribed = true;
- /* WMI command to enable pktlog on the firmware */
- if (pktlog_enable_tgt(scn, log_state, ini_triggered,
- user_triggered)) {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- printk("Device cannot be enabled, %s\n", __func__);
- return -EINVAL;
- }
- if (is_iwpriv_command == 0)
- pl_dev->vendor_cmd_send = true;
- } else {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- pl_dev->pl_funcs->pktlog_disable(scn);
- if (is_iwpriv_command == 0)
- pl_dev->vendor_cmd_send = false;
- }
- pl_info->log_state = log_state;
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- return 0;
- }
- int pktlog_enable(struct hif_opaque_softc *scn, int32_t log_state,
- bool ini_triggered, uint8_t user_triggered,
- uint32_t is_iwpriv_command)
- {
- struct ol_pktlog_dev_t *pl_dev;
- struct ath_pktlog_info *pl_info;
- struct ol_txrx_pdev_t *txrx_pdev;
- int error;
- if (!scn) {
- printk("%s: Invalid scn context\n", __func__);
- ASSERT(0);
- return -EINVAL;
- }
- txrx_pdev = cds_get_context(QDF_MODULE_ID_TXRX);
- if (!txrx_pdev) {
- printk("%s: Invalid txrx_pdev context\n", __func__);
- ASSERT(0);
- return -EINVAL;
- }
- pl_dev = txrx_pdev->pl_dev;
- if (!pl_dev) {
- printk("%s: Invalid pktlog context\n", __func__);
- ASSERT(0);
- return -EINVAL;
- }
- pl_info = pl_dev->pl_info;
- if (!pl_info)
- return 0;
- mutex_lock(&pl_info->pktlog_mutex);
- error = __pktlog_enable(scn, log_state, ini_triggered,
- user_triggered, is_iwpriv_command);
- mutex_unlock(&pl_info->pktlog_mutex);
- return error;
- }
- static int __pktlog_setsize(struct hif_opaque_softc *scn, int32_t size)
- {
- ol_txrx_pdev_handle pdev_txrx_handle =
- cds_get_context(QDF_MODULE_ID_TXRX);
- struct ol_pktlog_dev_t *pl_dev;
- struct ath_pktlog_info *pl_info;
- if (pdev_txrx_handle == NULL ||
- pdev_txrx_handle->pl_dev == NULL ||
- pdev_txrx_handle->pl_dev->pl_info == NULL)
- return -EFAULT;
- pl_dev = pdev_txrx_handle->pl_dev;
- pl_info = pl_dev->pl_info;
- if (pl_info->curr_pkt_state < PKTLOG_OPR_NOT_IN_PROGRESS)
- return -EBUSY;
- pl_info->curr_pkt_state = PKTLOG_OPR_IN_PROGRESS;
- if (size < 0) {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- return -EINVAL;
- }
- if (size == pl_info->buf_size) {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- qdf_print("%s: Pktlog Buff Size is already of same size.",
- __func__);
- return 0;
- }
- if (pl_info->log_state) {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- qdf_print("%s: Logging should be disabled before changing"
- "buffer size.", __func__);
- return -EINVAL;
- }
- spin_lock_bh(&pl_info->log_lock);
- if (pl_info->buf != NULL) {
- if (pl_dev->is_pktlog_cb_subscribed &&
- wdi_pktlog_unsubscribe(pdev_txrx_handle,
- pl_info->log_state)) {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- printk("Cannot unsubscribe pktlog from the WDI\n");
- spin_unlock_bh(&pl_info->log_lock);
- return -EFAULT;
- }
- pktlog_release_buf(pdev_txrx_handle);
- pl_dev->is_pktlog_cb_subscribed = false;
- pl_dev->tgt_pktlog_alloced = false;
- }
- if (size != 0) {
- qdf_print("%s: New Pktlog Buff Size is %d\n", __func__, size);
- pl_info->buf_size = size;
- }
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- spin_unlock_bh(&pl_info->log_lock);
- return 0;
- }
- int pktlog_setsize(struct hif_opaque_softc *scn, int32_t size)
- {
- int status;
- ol_txrx_pdev_handle pdev_txrx_handle =
- cds_get_context(QDF_MODULE_ID_TXRX);
- struct ol_pktlog_dev_t *pl_dev;
- struct ath_pktlog_info *pl_info;
- if (pdev_txrx_handle == NULL ||
- pdev_txrx_handle->pl_dev == NULL ||
- pdev_txrx_handle->pl_dev->pl_info == NULL)
- return -EFAULT;
- pl_dev = pdev_txrx_handle->pl_dev;
- pl_info = pl_dev->pl_info;
- mutex_lock(&pl_info->pktlog_mutex);
- status = __pktlog_setsize(scn, size);
- mutex_unlock(&pl_info->pktlog_mutex);
- return status;
- }
- int pktlog_clearbuff(struct hif_opaque_softc *scn, bool clear_buff)
- {
- ol_txrx_pdev_handle pdev_txrx_handle =
- cds_get_context(QDF_MODULE_ID_TXRX);
- struct ol_pktlog_dev_t *pl_dev;
- struct ath_pktlog_info *pl_info;
- uint8_t save_pktlog_state;
- if (pdev_txrx_handle == NULL ||
- pdev_txrx_handle->pl_dev == NULL ||
- pdev_txrx_handle->pl_dev->pl_info == NULL)
- return -EFAULT;
- pl_dev = pdev_txrx_handle->pl_dev;
- pl_info = pl_dev->pl_info;
- if (!clear_buff)
- return -EINVAL;
- if (pl_info->curr_pkt_state < PKTLOG_OPR_IN_PROGRESS_READ_COMPLETE ||
- pl_info->curr_pkt_state ==
- PKTLOG_OPR_IN_PROGRESS_CLEARBUFF_COMPLETE)
- return -EBUSY;
- save_pktlog_state = pl_info->curr_pkt_state;
- pl_info->curr_pkt_state = PKTLOG_OPR_IN_PROGRESS;
- if (pl_info->log_state) {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- qdf_print("%s: Logging should be disabled before clearing "
- "pktlog buffer.", __func__);
- return -EINVAL;
- }
- if (pl_info->buf != NULL) {
- if (pl_info->buf_size > 0) {
- qdf_print("%s: pktlog buffer is cleared.", __func__);
- memset(pl_info->buf, 0, pl_info->buf_size);
- pl_dev->is_pktlog_cb_subscribed = false;
- pl_dev->tgt_pktlog_alloced = false;
- pl_info->buf->rd_offset = -1;
- } else {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- qdf_print("%s: pktlog buffer size is not proper. "
- "Existing Buf size %d", __func__,
- pl_info->buf_size);
- return -EFAULT;
- }
- } else {
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- qdf_print("%s: pktlog buff is NULL", __func__);
- return -EFAULT;
- }
- if (save_pktlog_state == PKTLOG_OPR_IN_PROGRESS_READ_COMPLETE)
- pl_info->curr_pkt_state =
- PKTLOG_OPR_IN_PROGRESS_CLEARBUFF_COMPLETE;
- else
- pl_info->curr_pkt_state = PKTLOG_OPR_NOT_IN_PROGRESS;
- return 0;
- }
- /**
- * pktlog_process_fw_msg() - process packetlog message
- * @buff: buffer
- *
- * Return: None
- */
- void pktlog_process_fw_msg(uint32_t *buff)
- {
- uint32_t *pl_hdr;
- uint32_t log_type;
- struct ol_txrx_pdev_t *txrx_pdev = cds_get_context(QDF_MODULE_ID_TXRX);
- if (!txrx_pdev) {
- qdf_print("%s: txrx_pdev is NULL", __func__);
- return;
- }
- pl_hdr = buff;
- log_type =
- (*(pl_hdr + 1) & ATH_PKTLOG_HDR_LOG_TYPE_MASK) >>
- ATH_PKTLOG_HDR_LOG_TYPE_SHIFT;
- if ((log_type == PKTLOG_TYPE_TX_CTRL)
- || (log_type == PKTLOG_TYPE_TX_STAT)
- || (log_type == PKTLOG_TYPE_TX_MSDU_ID)
- || (log_type == PKTLOG_TYPE_TX_FRM_HDR)
- || (log_type == PKTLOG_TYPE_TX_VIRT_ADDR))
- wdi_event_handler(WDI_EVENT_TX_STATUS,
- txrx_pdev, pl_hdr);
- else if (log_type == PKTLOG_TYPE_RC_FIND)
- wdi_event_handler(WDI_EVENT_RATE_FIND,
- txrx_pdev, pl_hdr);
- else if (log_type == PKTLOG_TYPE_RC_UPDATE)
- wdi_event_handler(WDI_EVENT_RATE_UPDATE,
- txrx_pdev, pl_hdr);
- else if (log_type == PKTLOG_TYPE_RX_STAT)
- wdi_event_handler(WDI_EVENT_RX_DESC,
- txrx_pdev, pl_hdr);
- else if (log_type == PKTLOG_TYPE_SW_EVENT)
- wdi_event_handler(WDI_EVENT_SW_EVENT,
- txrx_pdev, pl_hdr);
- }
- #if defined(QCA_WIFI_3_0_ADRASTEA)
- /**
- * pktlog_t2h_msg_handler() - Target to host message handler
- * @context: pdev context
- * @pkt: HTC packet
- *
- * Return: None
- */
- static void pktlog_t2h_msg_handler(void *context, HTC_PACKET *pkt)
- {
- struct ol_pktlog_dev_t *pdev = (struct ol_pktlog_dev_t *)context;
- qdf_nbuf_t pktlog_t2h_msg = (qdf_nbuf_t) pkt->pPktContext;
- uint32_t *msg_word;
- /* check for successful message reception */
- if (pkt->Status != QDF_STATUS_SUCCESS) {
- if (pkt->Status != QDF_STATUS_E_CANCELED)
- pdev->htc_err_cnt++;
- qdf_nbuf_free(pktlog_t2h_msg);
- return;
- }
- /* confirm alignment */
- qdf_assert((((unsigned long)qdf_nbuf_data(pktlog_t2h_msg)) & 0x3) == 0);
- msg_word = (uint32_t *) qdf_nbuf_data(pktlog_t2h_msg);
- pktlog_process_fw_msg(msg_word);
- qdf_nbuf_free(pktlog_t2h_msg);
- }
- /**
- * pktlog_tx_resume_handler() - resume callback
- * @context: pdev context
- *
- * Return: None
- */
- static void pktlog_tx_resume_handler(void *context)
- {
- qdf_print("%s: Not expected", __func__);
- qdf_assert(0);
- }
- /**
- * pktlog_h2t_send_complete() - send complete indication
- * @context: pdev context
- * @htc_pkt: HTC packet
- *
- * Return: None
- */
- static void pktlog_h2t_send_complete(void *context, HTC_PACKET *htc_pkt)
- {
- qdf_print("%s: Not expected", __func__);
- qdf_assert(0);
- }
- /**
- * pktlog_h2t_full() - queue full indication
- * @context: pdev context
- * @pkt: HTC packet
- *
- * Return: HTC action
- */
- static enum htc_send_full_action pktlog_h2t_full(void *context, HTC_PACKET *pkt)
- {
- return HTC_SEND_FULL_KEEP;
- }
- /**
- * pktlog_htc_connect_service() - create new endpoint for packetlog
- * @pdev - pktlog pdev
- *
- * Return: 0 for success/failure
- */
- static int pktlog_htc_connect_service(struct ol_pktlog_dev_t *pdev)
- {
- struct htc_service_connect_req connect;
- struct htc_service_connect_resp response;
- QDF_STATUS status;
- qdf_mem_set(&connect, sizeof(connect), 0);
- qdf_mem_set(&response, sizeof(response), 0);
- connect.pMetaData = NULL;
- connect.MetaDataLength = 0;
- connect.EpCallbacks.pContext = pdev;
- connect.EpCallbacks.EpTxComplete = pktlog_h2t_send_complete;
- connect.EpCallbacks.EpTxCompleteMultiple = NULL;
- connect.EpCallbacks.EpRecv = pktlog_t2h_msg_handler;
- connect.EpCallbacks.ep_resume_tx_queue = pktlog_tx_resume_handler;
- /* rx buffers currently are provided by HIF, not by EpRecvRefill */
- connect.EpCallbacks.EpRecvRefill = NULL;
- connect.EpCallbacks.RecvRefillWaterMark = 1;
- /* N/A, fill is done by HIF */
- connect.EpCallbacks.EpSendFull = pktlog_h2t_full;
- /*
- * Specify how deep to let a queue get before htc_send_pkt will
- * call the EpSendFull function due to excessive send queue depth.
- */
- connect.MaxSendQueueDepth = PKTLOG_MAX_SEND_QUEUE_DEPTH;
- /* disable flow control for HTT data message service */
- connect.ConnectionFlags |= HTC_CONNECT_FLAGS_DISABLE_CREDIT_FLOW_CTRL;
- /* connect to control service */
- connect.service_id = PACKET_LOG_SVC;
- status = htc_connect_service(pdev->htc_pdev, &connect, &response);
- if (status != QDF_STATUS_SUCCESS) {
- pdev->mt_pktlog_enabled = false;
- return -EIO; /* failure */
- }
- pdev->htc_endpoint = response.Endpoint;
- pdev->mt_pktlog_enabled = true;
- return 0; /* success */
- }
- /**
- * pktlog_htc_attach() - attach pktlog HTC service
- *
- * Return: 0 for success/failure
- */
- int pktlog_htc_attach(void)
- {
- struct ol_txrx_pdev_t *txrx_pdev = cds_get_context(QDF_MODULE_ID_TXRX);
- struct ol_pktlog_dev_t *pdev = NULL;
- void *htc_pdev = cds_get_context(QDF_MODULE_ID_HTC);
- if ((!txrx_pdev) || (!txrx_pdev->pl_dev) || (!htc_pdev))
- return -EINVAL;
- pdev = txrx_pdev->pl_dev;
- pdev->htc_pdev = htc_pdev;
- return pktlog_htc_connect_service(pdev);
- }
- #else
- int pktlog_htc_attach(void)
- {
- struct ol_txrx_pdev_t *txrx_pdev = cds_get_context(QDF_MODULE_ID_TXRX);
- struct ol_pktlog_dev_t *pdev = NULL;
- if (!txrx_pdev)
- return -EINVAL;
- pdev = txrx_pdev->pl_dev;
- pdev->mt_pktlog_enabled = false;
- return 0;
- }
- #endif
- #endif /* REMOVE_PKT_LOG */
|