[WCNCR00148316] misc: add set noise/get noise command
[Description]
Add iwpriv driver set_noise/get_noise command
1.provide command for WF0/WF1 noise measurement
2.command format
"set_noise <Sel>"
Sel: start/restart noise measurement (1)
stop noise measurement (0)
"get_noise"
show: Noise Idle Avg. Power: WF0: X dB WF1: Y dB
Avg. time: b/w enable noise measure to get_noise
3. command example
a. iwpriv wlan0 driver "set_noise 1" //start
b. wait a while
c. iwpriv wlan0 driver "get_noise"
d. iwpriv wlan0 driver "set_noise 0" //stop
Change-Id: Ic9fdf185ccbfceab6391d589fcf7d656824b23e7
Feature: misc
Signed-off-by: Saker Hsia <saker.hsia@mediatek.com>
CR-Id: WCNCR00148316
diff --git a/os/linux/gl_wext_priv.c b/os/linux/gl_wext_priv.c
index 104ac01..b88b70e 100644
--- a/os/linux/gl_wext_priv.c
+++ b/os/linux/gl_wext_priv.c
@@ -2322,7 +2322,10 @@
#define CMD_GET_CNM_INFO "GET_CNM"
#if CFG_SUPPORT_ADVANCE_CONTROL
-#define CMD_SW_DBGCTL_ADVCTL_ID 0xa1260000
+#define CMD_SW_DBGCTL_ADVCTL_SET_ID 0xa1260000
+#define CMD_SW_DBGCTL_ADVCTL_GET_ID 0xb1260000
+#define CMD_SET_NOISE "SET_NOISE"
+#define CMD_GET_NOISE "GET_NOISE"
#define CMD_SET_POP "SET_POP"
#define CMD_SET_ED "SET_ED"
#define CMD_SET_PD "SET_PD"
@@ -8003,6 +8006,102 @@
}
#if CFG_SUPPORT_ADVANCE_CONTROL
+static int priv_driver_set_noise(IN struct net_device *prNetDev, IN char *pcCommand, IN int i4TotalLen)
+{
+ P_GLUE_INFO_T prGlueInfo = NULL;
+ WLAN_STATUS rStatus = WLAN_STATUS_SUCCESS;
+ UINT_32 u4BufLen = 0;
+ INT_32 i4BytesWritten = 0;
+ INT_32 i4Argc = 0;
+ PCHAR apcArgv[WLAN_CFG_ARGV_MAX] = { 0 };
+ INT_32 u4Ret = 0;
+ UINT_32 u4Id = CMD_SW_DBGCTL_ADVCTL_SET_ID + 1;
+ UINT_32 u4Sel = 0;
+ PARAM_CUSTOM_SW_CTRL_STRUCT_T rSwCtrlInfo;
+
+ ASSERT(prNetDev);
+ if (GLUE_CHK_PR2(prNetDev, pcCommand) == FALSE)
+ return -1;
+ prGlueInfo = *((P_GLUE_INFO_T *) netdev_priv(prNetDev));
+
+ DBGLOG(REQ, LOUD, "command is %s\n", pcCommand);
+ wlanCfgParseArgument(pcCommand, &i4Argc, apcArgv);
+ DBGLOG(REQ, LOUD, "argc is %i\n", i4Argc);
+
+ rSwCtrlInfo.u4Id = u4Id;
+
+ if (i4Argc <= 1) {
+ DBGLOG(REQ, ERROR, "Argc(%d) ERR: SET_NOISE <Sel>\n", i4Argc);
+ return -1;
+ }
+
+ u4Ret = kalkStrtou32(apcArgv[1], 0, &u4Sel);
+ if (u4Ret)
+ DBGLOG(REQ, ERROR, "parse rSwCtrlInfo error u4Ret=%d\n", u4Ret);
+
+ rSwCtrlInfo.u4Data = u4Sel << 30;
+ DBGLOG(REQ, LOUD, "u4Sel=%d u4Data=0x%x,\n", u4Sel, rSwCtrlInfo.u4Data);
+ rStatus = kalIoctl(prGlueInfo,
+ wlanoidSetSwCtrlWrite,
+ &rSwCtrlInfo, sizeof(rSwCtrlInfo), FALSE, FALSE, TRUE, &u4BufLen);
+
+ if (rStatus != WLAN_STATUS_SUCCESS) {
+ DBGLOG(REQ, ERROR, "ERR: kalIoctl fail (%d)\n", rStatus);
+ return -1;
+ }
+
+ return i4BytesWritten;
+
+}
+
+static int priv_driver_get_noise(IN struct net_device *prNetDev, IN char *pcCommand, IN int i4TotalLen)
+{
+ P_GLUE_INFO_T prGlueInfo = NULL;
+ WLAN_STATUS rStatus = WLAN_STATUS_SUCCESS;
+ UINT_32 u4BufLen = 0;
+ INT_32 i4BytesWritten = 0;
+ INT_32 i4Argc = 0;
+ PCHAR apcArgv[WLAN_CFG_ARGV_MAX] = { 0 };
+ UINT_32 u4Id = CMD_SW_DBGCTL_ADVCTL_GET_ID + 1;
+ UINT_32 u4Offset = 0;
+ PARAM_CUSTOM_SW_CTRL_STRUCT_T rSwCtrlInfo;
+ INT_16 u2Wf0AvgPwr, u2Wf1AvgPwr;
+
+ ASSERT(prNetDev);
+
+ prGlueInfo = *((P_GLUE_INFO_T *) netdev_priv(prNetDev));
+
+ ASSERT(prNetDev);
+ if (GLUE_CHK_PR2(prNetDev, pcCommand) == FALSE)
+ return -1;
+ prGlueInfo = *((P_GLUE_INFO_T *) netdev_priv(prNetDev));
+
+ DBGLOG(REQ, LOUD, "command is %s\n", pcCommand);
+ wlanCfgParseArgument(pcCommand, &i4Argc, apcArgv);
+
+ rSwCtrlInfo.u4Data = 0;
+ rSwCtrlInfo.u4Id = u4Id;
+
+ rStatus = kalIoctl(prGlueInfo,
+ wlanoidQuerySwCtrlRead,
+ &rSwCtrlInfo, sizeof(rSwCtrlInfo), TRUE, TRUE, TRUE, &u4BufLen);
+
+ DBGLOG(REQ, LOUD, "rStatus %u\n", rStatus);
+ if (rStatus != WLAN_STATUS_SUCCESS)
+ return -1;
+
+ u2Wf0AvgPwr = rSwCtrlInfo.u4Data & 0xFFFF;
+ u2Wf1AvgPwr = (rSwCtrlInfo.u4Data >> 16) & 0xFFFF;
+
+ u4Offset += snprintf(pcCommand + u4Offset, i4TotalLen - u4Offset,
+ "Noise Idle Avg. Power: WF0:%ddB WF1:%ddB\n", u2Wf0AvgPwr, u2Wf1AvgPwr);
+
+ i4BytesWritten = (INT_32)u4Offset;
+
+ return i4BytesWritten;
+
+} /* priv_driver_get_sw_ctrl */
+
static int priv_driver_set_pop(IN struct net_device *prNetDev, IN char *pcCommand, IN int i4TotalLen)
{
P_GLUE_INFO_T prGlueInfo = NULL;
@@ -8012,7 +8111,7 @@
INT_32 i4Argc = 0;
PCHAR apcArgv[WLAN_CFG_ARGV_MAX] = { 0 };
INT_32 u4Ret = 0;
- UINT_32 u4Id = CMD_SW_DBGCTL_ADVCTL_ID + 2;
+ UINT_32 u4Id = CMD_SW_DBGCTL_ADVCTL_SET_ID + 2;
UINT_32 u4Sel = 0, u4CckTh = 0, u4OfdmTh = 0;
PARAM_CUSTOM_SW_CTRL_STRUCT_T rSwCtrlInfo;
@@ -8067,7 +8166,7 @@
INT_32 i4Argc = 0;
PCHAR apcArgv[WLAN_CFG_ARGV_MAX] = { 0 };
INT_32 u4Ret = 0, u4EdVal = 0;
- UINT_32 u4Id = CMD_SW_DBGCTL_ADVCTL_ID + 3;
+ UINT_32 u4Id = CMD_SW_DBGCTL_ADVCTL_SET_ID + 3;
UINT_32 u4Sel = 0;
PARAM_CUSTOM_SW_CTRL_STRUCT_T rSwCtrlInfo;
@@ -8120,7 +8219,7 @@
INT_32 i4Argc = 0;
PCHAR apcArgv[WLAN_CFG_ARGV_MAX] = { 0 };
INT_32 u4Ret = 0;
- UINT_32 u4Id = CMD_SW_DBGCTL_ADVCTL_ID + 4;
+ UINT_32 u4Id = CMD_SW_DBGCTL_ADVCTL_SET_ID + 4;
UINT_32 u4Sel = 0;
INT_32 u4CckTh = 0, u4OfdmTh = 0;
PARAM_CUSTOM_SW_CTRL_STRUCT_T rSwCtrlInfo;
@@ -8183,7 +8282,7 @@
INT_32 i4Argc = 0;
PCHAR apcArgv[WLAN_CFG_ARGV_MAX] = { 0 };
INT_32 u4Ret = 0;
- UINT_32 u4Id = CMD_SW_DBGCTL_ADVCTL_ID + 5;
+ UINT_32 u4Id = CMD_SW_DBGCTL_ADVCTL_SET_ID + 5;
UINT_32 u4Sel = 0;
INT_32 u4Wf0Gain = 0, u4Wf1Gain = 0;
PARAM_CUSTOM_SW_CTRL_STRUCT_T rSwCtrlInfo;
@@ -8455,6 +8554,10 @@
else if (strnicmp(pcCommand, CMD_EFUSE, sizeof(CMD_EFUSE)-1) == 0)
i4BytesWritten = priv_driver_efuse_ops(prNetDev, pcCommand, i4TotalLen);
#if CFG_SUPPORT_ADVANCE_CONTROL
+ else if (strnicmp(pcCommand, CMD_SET_NOISE, strlen(CMD_SET_NOISE)) == 0)
+ i4BytesWritten = priv_driver_set_noise(prNetDev, pcCommand, i4TotalLen);
+ else if (strnicmp(pcCommand, CMD_GET_NOISE, strlen(CMD_GET_NOISE)) == 0)
+ i4BytesWritten = priv_driver_get_noise(prNetDev, pcCommand, i4TotalLen);
else if (strnicmp(pcCommand, CMD_SET_POP, strlen(CMD_SET_POP)) == 0)
i4BytesWritten = priv_driver_set_pop(prNetDev, pcCommand, i4TotalLen);
else if (strnicmp(pcCommand, CMD_SET_ED, strlen(CMD_SET_ED)) == 0)