A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-26 06:33:19 -04:00
Code Issues Projects Releases Packages Wiki Activity

cnss2: Add code to send qdss mode and sysfs interface for qdss

Browse source 
Add code to send qdss mode request and sysfs interface for
qdss_start, qdss_stop and qdss_config_download.

Change-Id: Ic4a8eff0ce870aa433308440db7283d7012ac940
Signed-off-by: Sandeep Singh <sandsing@codeaurora.org>
This commit is contained in:
Sandeep Singh 2020-12-21 16:20:50 +05:30
commit 984c51ea4f
4 changed files with 163 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

60
drivers/net/wireless/cnss2/main.c
View file

@ -2583,14 +2583,74 @@ static ssize_t fs_ready_store(struct device *dev,
return count;
}
static ssize_t qdss_trace_start_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
struct cnss_plat_data *plat_priv = dev_get_drvdata(dev);
wlfw_qdss_trace_send_start(plat_priv);
cnss_pr_dbg("Received QDSS start command\n");
return count;
}
static ssize_t qdss_trace_stop_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
struct cnss_plat_data *plat_priv = dev_get_drvdata(dev);
u32 option = 0;
if (sscanf(buf, "%du", &option) != 1)
return -EINVAL;
wlfw_qdss_trace_send_stop(plat_priv, option);
cnss_pr_dbg("Received QDSS stop command\n");
return count;
}
static ssize_t qdss_conf_download_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
struct cnss_plat_data *plat_priv = dev_get_drvdata(dev);
cnss_wlfw_qdss_dnld_send_sync(plat_priv);
cnss_pr_dbg("Received QDSS download config command\n");
return count;
}
static ssize_t hw_trace_override_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
struct cnss_plat_data *plat_priv = dev_get_drvdata(dev);
int tmp = 0;
if (sscanf(buf, "%du", &tmp) != 1)
return -EINVAL;
plat_priv->hw_trc_override = tmp;
cnss_pr_dbg("Received QDSS hw_trc_override indication\n");
return count;
}
static DEVICE_ATTR_WO(fs_ready);
static DEVICE_ATTR_WO(shutdown);
static DEVICE_ATTR_WO(recovery);
static DEVICE_ATTR_WO(qdss_trace_start);
static DEVICE_ATTR_WO(qdss_trace_stop);
static DEVICE_ATTR_WO(qdss_conf_download);
static DEVICE_ATTR_WO(hw_trace_override);
static struct attribute *cnss_attrs[] = {
&dev_attr_fs_ready.attr,
&dev_attr_shutdown.attr,
&dev_attr_recovery.attr,
&dev_attr_qdss_trace_start.attr,
&dev_attr_qdss_trace_stop.attr,
&dev_attr_qdss_conf_download.attr,
&dev_attr_hw_trace_override.attr,
NULL,
};

1
drivers/net/wireless/cnss2/main.h
View file

@ -482,6 +482,7 @@ struct cnss_plat_data {
u8 pcie_gen_speed;
struct cnss_dms_data dms;
int power_up_error;
u32 hw_trc_override;
};
#ifdef CONFIG_ARCH_QCOM

91
drivers/net/wireless/cnss2/qmi.c
View file

@ -1029,6 +1029,97 @@ err_req_fw:
return ret;
}
static int wlfw_send_qdss_trace_mode_req
(struct cnss_plat_data *plat_priv,
enum wlfw_qdss_trace_mode_enum_v01 mode,
unsigned long long option)
{
int rc = 0;
int tmp = 0;
struct wlfw_qdss_trace_mode_req_msg_v01 *req;
struct wlfw_qdss_trace_mode_resp_msg_v01 *resp;
struct qmi_txn txn;
if (!plat_priv)
return -ENODEV;
req = kzalloc(sizeof(*req), GFP_KERNEL);
if (!req)
return -ENOMEM;
resp = kzalloc(sizeof(*resp), GFP_KERNEL);
if (!resp) {
kfree(req);
return -ENOMEM;
}
req->mode_valid = 1;
req->mode = mode;
req->option_valid = 1;
req->option = option;
tmp = plat_priv->hw_trc_override;
req->hw_trc_disable_override_valid = 1;
req->hw_trc_disable_override =
(tmp > QMI_PARAM_DISABLE_V01 ? QMI_PARAM_DISABLE_V01 :
(tmp < 0 ? QMI_PARAM_INVALID_V01 : tmp));
cnss_pr_dbg("%s: mode %u, option %llu, hw_trc_disable_override: %u",
__func__, mode, option, req->hw_trc_disable_override);
rc = qmi_txn_init(&plat_priv->qmi_wlfw, &txn,
wlfw_qdss_trace_mode_resp_msg_v01_ei, resp);
if (rc < 0) {
cnss_pr_err("Fail to init txn for QDSS Mode resp %d\n",
rc);
goto out;
}
rc = qmi_send_request(&plat_priv->qmi_wlfw, NULL, &txn,
QMI_WLFW_QDSS_TRACE_MODE_REQ_V01,
WLFW_QDSS_TRACE_MODE_REQ_MSG_V01_MAX_MSG_LEN,
wlfw_qdss_trace_mode_req_msg_v01_ei, req);
if (rc < 0) {
qmi_txn_cancel(&txn);
cnss_pr_err("Fail to send QDSS Mode req %d\n", rc);
goto out;
}
rc = qmi_txn_wait(&txn, plat_priv->ctrl_params.qmi_timeout);
if (rc < 0) {
cnss_pr_err("QDSS Mode resp wait failed with rc %d\n",
rc);
goto out;
} else if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
cnss_pr_err("QMI QDSS Mode request rejected, result:%d error:%d\n",
resp->resp.result, resp->resp.error);
rc = -resp->resp.result;
goto out;
}
kfree(resp);
kfree(req);
return rc;
out:
kfree(resp);
kfree(req);
CNSS_QMI_ASSERT();
return rc;
}
int wlfw_qdss_trace_send_start(struct cnss_plat_data *plat_priv)
{
return wlfw_send_qdss_trace_mode_req(plat_priv,
QMI_WLFW_QDSS_TRACE_ON_V01, 0);
}
int wlfw_qdss_trace_send_stop(struct cnss_plat_data *plat_priv, unsigned long long option)
{
return wlfw_send_qdss_trace_mode_req(plat_priv, QMI_WLFW_QDSS_TRACE_OFF_V01,
option);
}
int cnss_wlfw_wlan_mode_send_sync(struct cnss_plat_data *plat_priv,
enum cnss_driver_mode mode)
{

11
drivers/net/wireless/cnss2/qmi.h
View file

@ -80,6 +80,8 @@ void cnss_dms_deinit(struct cnss_plat_data *plat_priv);
int cnss_wlfw_qdss_dnld_send_sync(struct cnss_plat_data *plat_priv);
int cnss_wlfw_qdss_data_send_sync(struct cnss_plat_data *plat_priv, char *file_name,
u32 total_size);
int wlfw_qdss_trace_send_start(struct cnss_plat_data *plat_priv);
int wlfw_qdss_trace_send_stop(struct cnss_plat_data *plat_priv, unsigned long long option);
#else
#define QMI_WLFW_TIMEOUT_MS 10000
@ -274,6 +276,15 @@ int cnss_wlfw_qdss_data_send_sync(struct cnss_plat_data *plat_priv, char *file_n
return 0;
}
static inline void cnss_dms_deinit(struct cnss_plat_data *plat_priv) {}
int wlfw_qdss_trace_send_start(struct cnss_plat_data *plat_priv)
{
return 0;
}
int wlfw_qdss_trace_send_stop(struct cnss_plat_data *plat_priv, unsigned long long option)
{
return 0;
}
#endif /* CONFIG_CNSS2_QMI */
#ifdef CONFIG_CNSS2_DEBUG