commit 6b7ff5e81dddd20572950b48c1fe9c23505bc23c
author Saker Hsia <saker.hsia@mediatek.com> Thu Jan 19 21:05:47 2017 +0800
committer Saker Hsia <saker.hsia@mediatek.com> Thu Jan 26 13:36:34 2017 +0800
tree f1253918cfe126254560b6e23909bbbf9dd2dfa6
parent 1235346ea52ded300f236fba5e5e25d766e9044e

[WCNCR00148316] misc: add set pop command

[Description]
Add iwpriv driver set_pop command
1. Add CFG_SUPPORT_ADVANCE_CONTROL

Change-Id: I0fda033949c93c4f787c5dc6dcbe07c86ce67496
Feature: misc
Signed-off-by: Saker Hsia <saker.hsia@mediatek.com>
CR-Id: WCNCR00148316

include/config.h

diff --git a/include/config.h b/include/config.h
index a7cb895..5ccd8b4 100644
--- a/include/config.h
+++ b/include/config.h
@@ -932,6 +932,13 @@
  */
 #define CFG_SDIO_ASYNC_IRQ_AUTO_ENABLE	1
 
+
+/*------------------------------------------------------------------------------
+ * Advance Control for HW
+ *------------------------------------------------------------------------------
+ */
+#define CFG_SUPPORT_ADVANCE_CONTROL 1
+
 /*******************************************************************************
 *                             D A T A   T Y P E S
 ********************************************************************************

os/linux/gl_wext_priv.c

diff --git a/os/linux/gl_wext_priv.c b/os/linux/gl_wext_priv.c
index ace16f2..f5197d6 100644
--- a/os/linux/gl_wext_priv.c
+++ b/os/linux/gl_wext_priv.c
@@ -2321,6 +2321,9 @@
 
 #define CMD_GET_CNM_INFO		"GET_CNM"
 
+#if CFG_SUPPORT_ADVANCE_CONTROL
+#define CMD_SET_POP           "SET_POP"
+#endif
 static UINT_8 g_ucMiracastMode = MIRACAST_MODE_OFF;
 
 typedef struct cmd_tlv {
@@ -7972,6 +7975,63 @@
 	return (INT_32)u4Offset;
 }
 
+#if CFG_SUPPORT_ADVANCE_CONTROL
+static int priv_driver_set_pop(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 = 0xa1260002;
+	UINT_32 u4Sel = 0, u4CckTh = 0, u4OfdmTh = 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 <= 3) {
+		DBGLOG(REQ, ERROR, "Argc(%d) ERR: SET_POP <Sel> <CCK TH> <OFDM TH>\n", i4Argc);
+		return -1;
+	}
+
+	u4Ret = kalkStrtou32(apcArgv[1], 0, &(u4Sel));
+	if (u4Ret)
+		DBGLOG(REQ, LOUD, "parse rSwCtrlInfo error u4Ret=%d\n", u4Ret);
+	u4Ret = kalkStrtou32(apcArgv[2], 0, &(u4CckTh));
+	if (u4Ret)
+		DBGLOG(REQ, LOUD, "parse rSwCtrlInfo error u4Ret=%d\n", u4Ret);
+	u4Ret = kalkStrtou32(apcArgv[3], 0, &(u4OfdmTh));
+	if (u4Ret)
+		DBGLOG(REQ, LOUD, "parse rSwCtrlInfo error u4Ret=%d\n", u4Ret);
+
+	rSwCtrlInfo.u4Data = (u4CckTh | (u4OfdmTh<<8) | (u4Sel<<30));
+	DBGLOG(REQ, LOUD, "u4Enable=%d u4CckTh=%d u4OfdmTh=%d, u4Data=0x%x,\n",
+		u4Sel, u4CckTh, u4OfdmTh, 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;
+
+}
+
+#endif
 
 INT_32 priv_driver_cmds(IN struct net_device *prNetDev, IN PCHAR pcCommand, IN INT_32 i4TotalLen)
 {
@@ -8188,6 +8248,10 @@
 #endif
 		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_POP, strlen(CMD_SET_POP)) == 0)
+			i4BytesWritten = priv_driver_set_pop(prNetDev, pcCommand, i4TotalLen);
+#endif
 		else
 			i4CmdFound = 0;
 	}