INT Set_NfcPasswdToken_Proc(
IN RTMP_ADAPTER *pAd,
IN PSTRING arg)
{
POS_COOKIE pObj = (POS_COOKIE) pAd->OS_Cookie;
PWSC_CTRL pWscCtrl = &pAd->ApCfg.MBSSID[pObj->ioctl_if].WscControl;
PUCHAR pBuf = NULL;
USHORT BufLen = 0;
UCHAR action = 1, type = TYPE_PASSWORD;
UCHAR val=0;
BOOLEAN bHandover=FALSE;
/*
Action: b¡¦<7:6>: 0x00 ¡V Request, 0x01 ¡V Notify
b¡¦<5:0>: 0x00 ¡V Get, 0x01 - Set
*/
val = (UCHAR)simple_strtol(arg, 0, 10);
if (val == 1) /* Password Token */
{
bHandover = FALSE;
type = TYPE_PASSWORD;
}
else if (val == 2) /* Handover Select */
{
bHandover = TRUE;
type = TYPE_PASSWDHO_S;
}
else if (val == 3) /* Handover Request */
{
bHandover = TRUE;
type = TYPE_PASSWDHO_R;
}
os_alloc_mem(pAd, (UCHAR **)&pBuf, (NFC_WSC_TLV_SIZE*sizeof(UCHAR)));
if (pBuf == NULL)
{
return FALSE;
}
DBGPRINT(RT_DEBUG_TRACE, ("%s: NfcBuildOOBDevPasswdTLV value(=%d) type(=%d)\n", __FUNCTION__,val, type));
NfcBuildOOBDevPasswdTLV(pAd, pWscCtrl, type, pBuf, &BufLen);
if (pBuf && (BufLen != 0))
{
pWscCtrl->bTriggerByNFC = TRUE;
if (type ==TYPE_PASSWORD)
pWscCtrl->NfcModel = MODEL_PASSWORD_TOKEN;
else
pWscCtrl->NfcModel = MODEL_HANDOVER;
DBGPRINT(RT_DEBUG_TRACE, ("%s: NfcBuildOOBDevPasswdTLV NfcModel(=%d)\n", __FUNCTION__,pWscCtrl->NfcModel));
NfcCommand(pAd, action, type, BufLen, pBuf);
os_free_mem(NULL, pBuf);
}
return TRUE;
}
INT Get_NfcStatus_Proc(RTMP_ADAPTER *pAd, RTMP_STRING *arg)
{
UCHAR data = 0;
/*
Action: b¡¦<7:6>: 0x0 ¡V To NFC, 0x1 ¡V From NFC
b¡¦<5:0>: 0x0 ¡V Get, 0x01 - Set
*/
UCHAR action = 0, type = TYPE_NFC_STATUS; /* 5 - NFC Status */
NfcCommand(pAd, action, type, 0, NULL);
return TRUE;
}
INT Set_NfcConfigurationToken_Proc(
IN RTMP_ADAPTER *pAd,
IN PSTRING arg)
{
POS_COOKIE pObj = (POS_COOKIE) pAd->OS_Cookie;
PWSC_CTRL pWscCtrl = &pAd->ApCfg.MBSSID[pObj->ioctl_if].WscControl;
PUCHAR pBuf = NULL;
USHORT BufLen = 0;
/*
Action: b¡¦<7:6>: 0x00 ¡V Request, 0x01 ¡V Notify
b¡¦<5:0>: 0x00 ¡V Get, 0x01 - Set
*/
UCHAR action = 1, type = TYPE_CONFIGURATION;
os_alloc_mem(pAd, (UCHAR **)&pBuf, (NFC_WSC_TLV_SIZE*sizeof(UCHAR)));
if (pBuf == NULL)
{
return FALSE;
}
NfcBuildWscProfileTLV(pAd, pWscCtrl, pBuf, &BufLen);
if (pBuf && (BufLen != 0))
{
NfcCommand(pAd, action, type, BufLen, pBuf);
os_free_mem(NULL, pBuf);
}
if ((pAd->OpMode == OPMODE_AP) && (pWscCtrl->WscConfStatus == WSC_SCSTATE_UNCONFIGURED))
{
pWscCtrl->WscConfStatus = WSC_SCSTATE_CONFIGURED;
WscBuildBeaconIE(pAd, WSC_SCSTATE_CONFIGURED, FALSE, 0, 0, 0, NULL, 0,AP_MODE);
WscBuildProbeRespIE(pAd, WSC_MSGTYPE_AP_WLAN_MGR, WSC_SCSTATE_CONFIGURED, FALSE, 0, 0, 0, NULL, 0,AP_MODE);
APUpdateAllBeaconFrame(pAd);
}
if (pWscCtrl->WscUpdatePortCfgTimerRunning)
{
BOOLEAN bCancel;
RTMPCancelTimer(&pWscCtrl->WscUpdatePortCfgTimer, &bCancel);
}
else
pWscCtrl->WscUpdatePortCfgTimerRunning = TRUE;
RTMPSetTimer(&pWscCtrl->WscUpdatePortCfgTimer, 1000);
return TRUE;
}
INT Set_NfcStatus_Proc(RTMP_ADAPTER *pAd, RTMP_STRING *arg)
{
UCHAR data = 0;
/*
Action: b¡¦<7:6>: 0x00 ¡V Request, 0x01 ¡V Notify
b¡¦<5:0>: 0x00 ¡V Get, 0x01 - Set
*/
UCHAR action = 1, type = TYPE_NFC_STATUS; /* 5 - NFC Status */
if (simple_strtol(arg, 0, 10) != 0)
data = 1;
data = (UCHAR)simple_strtol(arg, 0, 10);
MTWF_LOG(DBG_CAT_ALL, DBG_SUBCAT_ALL, DBG_LVL_TRACE, ("%s: Set NFC Status(=%d)\n", __FUNCTION__, data));
NfcCommand(pAd, action, type, 1, &data);
return TRUE;
}
VOID NfcParseRspCommand(
IN PRTMP_ADAPTER pAd,
IN PUCHAR pData,
IN USHORT DataLen)
{
NFC_CMD_INFO *pNfcCmdInfo = NULL;
BOOLEAN bSetFromNfc = FALSE;
PWSC_CTRL pWscCtrl = &pAd->ApCfg.MBSSID[0].WscControl;
DBGPRINT(RT_DEBUG_TRACE, ("====> %s\n", __FUNCTION__));
hex_dump("Packet", pData, DataLen);
os_alloc_mem(pAd, (UCHAR **)&pNfcCmdInfo, (DataLen*sizeof(UCHAR)));
if (pNfcCmdInfo)
{
NdisMoveMemory(pNfcCmdInfo, pData, DataLen);
hex_dump("Packet", &pNfcCmdInfo->data[0], pNfcCmdInfo->data_len);
bSetFromNfc = ((pNfcCmdInfo->action & 0x41) == 0x41);
DBGPRINT(RT_DEBUG_TRACE, ("==> vendor_id: 0x%04x, action = 0x%0x, type = %d, data_len = %u, bSetFromNfc = %d\n",
pNfcCmdInfo->vendor_id, pNfcCmdInfo->action, pNfcCmdInfo->type, pNfcCmdInfo->data_len, bSetFromNfc));
switch(pNfcCmdInfo->type)
{
case TYPE_CMD_RESULT:
DBGPRINT(RT_DEBUG_TRACE, ("TYPE_CMD_RESULT(=%d): Command result = %d\n", pNfcCmdInfo->type, pNfcCmdInfo->data[0]));
break;
case TYPE_CONFIGURATION:
DBGPRINT(RT_DEBUG_TRACE, ("TYPE_CONFIGURATION(=%d)\n", pNfcCmdInfo->type));
if (bSetFromNfc)
{
if (pNfcCmdInfo->data_len != 1)
{
/*
Receive Configuration from NFC daemon.
*/
if (WscProcessCredential(pAd, &pNfcCmdInfo->data[0], pNfcCmdInfo->data_len, pWscCtrl) == FALSE)
{
DBGPRINT(RT_DEBUG_TRACE, ("ProcessCredential fail..\n"));
}
else
{
if ((pAd->OpMode == OPMODE_AP) && (pWscCtrl->WscConfStatus == WSC_SCSTATE_UNCONFIGURED))
{
pWscCtrl->WscConfStatus = WSC_SCSTATE_CONFIGURED;
WscBuildBeaconIE(pAd, WSC_SCSTATE_CONFIGURED, FALSE, 0, 0, 0, NULL, 0, AP_MODE);
WscBuildProbeRespIE(pAd, WSC_MSGTYPE_AP_WLAN_MGR, WSC_SCSTATE_CONFIGURED, FALSE, 0, 0, 0, NULL, 0, AP_MODE);
APUpdateAllBeaconFrame(pAd);
}
if (pWscCtrl->WscUpdatePortCfgTimerRunning)
{
BOOLEAN bCancel;
RTMPCancelTimer(&pWscCtrl->WscUpdatePortCfgTimer, &bCancel);
}
else
pWscCtrl->WscUpdatePortCfgTimerRunning = TRUE;
RTMPSetTimer(&pWscCtrl->WscUpdatePortCfgTimer, 1000);
}
}
}
else
{
Set_NfcConfigurationToken_Proc(pAd, "1");
}
break;
case TYPE_PASSWORD:
DBGPRINT(RT_DEBUG_TRACE, ("TYPE_PASSWORD(=%d)\n", pNfcCmdInfo->type));
if (bSetFromNfc)
{
if (pNfcCmdInfo->data_len != 1)
{
/*
Receive Passwd from NFC daemon.
*/
NfcProcessPasswdTV(pAd, &pNfcCmdInfo->data[0], pNfcCmdInfo->data_len, pWscCtrl, FALSE);
WscGetConfWithoutTrigger(pAd, pWscCtrl, FALSE);
pWscCtrl->bTriggerByNFC = TRUE;
pWscCtrl->NfcModel = MODEL_PASSWORD_TOKEN;
}
}
else
{
Set_NfcPasswdToken_Proc(pAd, "1");
}
break;
/* New type for Handover */
case TYPE_PASSWDHO_S:
DBGPRINT(RT_DEBUG_TRACE, ("TYPE_PASSWDHO_S(=%d)\n", pNfcCmdInfo->type));
if (bSetFromNfc)
{
if (pNfcCmdInfo->data_len != 1)
{
/*
Receive Passwd from NFC daemon. "So far" no this case.
Due to AP always as Registrar in handover procedure,
AP only receive "Handover Request Message".
*/
NfcProcessPasswdTV(pAd, &pNfcCmdInfo->data[0], pNfcCmdInfo->data_len, pWscCtrl, TRUE);
WscGetConfWithoutTrigger(pAd, pWscCtrl, FALSE);
pWscCtrl->bTriggerByNFC = TRUE;
pWscCtrl->NfcModel = MODEL_HANDOVER; /* 2 */
}
}
else
{
Set_NfcPasswdToken_Proc(pAd, "2");
}
break;
case TYPE_PASSWDHO_R:
DBGPRINT(RT_DEBUG_TRACE, ("TYPE_PASSWDHO_R(=%d)\n", pNfcCmdInfo->type));
if (bSetFromNfc)
{
if (pNfcCmdInfo->data_len != 1)
{
/*
Receive Passwd from NFC daemon.
*/
NfcProcessPasswdTV(pAd, &pNfcCmdInfo->data[0], pNfcCmdInfo->data_len, pWscCtrl, TRUE);
WscGetConfWithoutTrigger(pAd, pWscCtrl, FALSE);
pWscCtrl->bTriggerByNFC = TRUE;
pWscCtrl->NfcModel = MODEL_HANDOVER; /* 2 */
}
}
else
{
/*
"So far" no this case.
Due to AP always as Registrar in handover procedure,
AP only send "Handover Select Message".
*/
Set_NfcPasswdToken_Proc(pAd, "3");
}
break;
case TYPE_NFC_STATUS:
DBGPRINT(RT_DEBUG_TRACE, ("TYPE_NFC_STATUS(=%d): NFC Status = %d\n", pNfcCmdInfo->type, pNfcCmdInfo->data[0]));
pWscCtrl->NfcStatus = pNfcCmdInfo->data[0];
break;
case TYPE_WIFI_RADIO_STATUS:
DBGPRINT(RT_DEBUG_TRACE, ("TYPE_WIFI_RADIO_STATUS(=%d)\n", pNfcCmdInfo->type));
if (bSetFromNfc)
{
if (pNfcCmdInfo->data[0] == 1)
MlmeRadioOn(pAd);
else
MlmeRadioOff(pAd);
}
else
{
UCHAR RadioStatus = 0;
if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_RADIO_OFF))
RadioStatus = 0;
else
RadioStatus = 1;
NfcCommand(pAd, 0x01, TYPE_WIFI_RADIO_STATUS, 1, &RadioStatus);
}
break;
default:
DBGPRINT(RT_DEBUG_TRACE, ("Unknow type(=%d)\n", pNfcCmdInfo->type));
break;
}
os_free_mem(NULL, pNfcCmdInfo);
}
DBGPRINT(RT_DEBUG_TRACE, ("<==== %s\n", __FUNCTION__));
return;
}
