Staging: vt6656: Ensure power.c uses proper tabbing. (f9cfbe94) · Commits · e / devices / android_kernel_oneplus_sm7250

drivers/staging/vt6656/power.c

+201 −215

Original line number	Original line	Diff line number	Diff line
	@@ -91,40 +91,43 @@ void PSvEnablePowerSaving(void *hDeviceContext,
	//Warren:06-18-2004,the sequence must follow PSEN->AUTOSLEEP->GO2DOZE		//Warren:06-18-2004,the sequence must follow PSEN->AUTOSLEEP->GO2DOZE
	// enable power saving hw function		// enable power saving hw function
	MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_PSEN);		MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_PSEN);

	// Set AutoSleep		// Set AutoSleep
	MACvRegBitsOn(pDevice, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);		MACvRegBitsOn(pDevice, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);

	//Warren:MUST turn on this once before turn on AUTOSLEEP ,or the AUTOSLEEP doesn't work		//Warren:MUST turn on this once before turn on AUTOSLEEP ,or the AUTOSLEEP doesn't work
	MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_GO2DOZE);		MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_GO2DOZE);


	if (wListenInterval >= 2) {		if (wListenInterval >= 2) {

	// clear always listen beacon		// clear always listen beacon
	MACvRegBitsOff(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);		MACvRegBitsOff(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);

	// first time set listen next beacon		// first time set listen next beacon
	MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);		MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);

	pMgmt->wCountToWakeUp = wListenInterval;		pMgmt->wCountToWakeUp = wListenInterval;

	}		} else {
	else {

	// always listen beacon		// always listen beacon
	MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);		MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);
	pMgmt->wCountToWakeUp = 0;

			pMgmt->wCountToWakeUp = 0;
	}		}

	pDevice->bEnablePSMode = TRUE;		pDevice->bEnablePSMode = TRUE;

	if (pDevice->eOPMode == OP_MODE_ADHOC) {		if (pDevice->eOPMode == OP_MODE_ADHOC) {

	/* bMgrPrepareBeaconToSend((void ) pDevice, pMgmt); /		/* bMgrPrepareBeaconToSend((void ) pDevice, pMgmt); /

	}		}
	// We don't send null pkt in ad hoc mode since beacon will handle this.		// We don't send null pkt in ad hoc mode since beacon will handle this.
	else if (pDevice->eOPMode == OP_MODE_INFRASTRUCTURE) {		else if (pDevice->eOPMode == OP_MODE_INFRASTRUCTURE) {
	PSbSendNullPacket(pDevice);		PSbSendNullPacket(pDevice);
	}		}

	pDevice->bPWBitOn = TRUE;		pDevice->bPWBitOn = TRUE;
	DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "PS:Power Saving Mode Enable... \n");		DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "PS:Power Saving Mode Enable... \n");
	return;		return;
	@@ -145,27 +148,21 @@ void PSvDisablePowerSaving(void *hDeviceContext)
	PSDevice pDevice = (PSDevice)hDeviceContext;		PSDevice pDevice = (PSDevice)hDeviceContext;
	//PSMgmtObject pMgmt = &(pDevice->sMgmtObj);		//PSMgmtObject pMgmt = &(pDevice->sMgmtObj);


	// disable power saving hw function		// disable power saving hw function
	CONTROLnsRequestOut(pDevice,		CONTROLnsRequestOut(pDevice, MESSAGE_TYPE_DISABLE_PS, 0,
	MESSAGE_TYPE_DISABLE_PS,		0, 0, NULL);
	0,
	0,
	0,
	NULL
	);

	//clear AutoSleep		//clear AutoSleep
	MACvRegBitsOff(pDevice, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);		MACvRegBitsOff(pDevice, MAC_REG_PSCFG, PSCFG_AUTOSLEEP);

	// set always listen beacon		// set always listen beacon
	MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);		MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_ALBCN);

	pDevice->bEnablePSMode = FALSE;		pDevice->bEnablePSMode = FALSE;

	if (pDevice->eOPMode == OP_MODE_INFRASTRUCTURE) {		if (pDevice->eOPMode == OP_MODE_INFRASTRUCTURE) {
	PSbSendNullPacket(pDevice);		PSbSendNullPacket(pDevice);
	}		}

	pDevice->bPWBitOn = FALSE;		pDevice->bPWBitOn = FALSE;
	return;		return;
	}		}
	@@ -188,9 +185,10 @@ BOOL PSbConsiderPowerDown(void *hDeviceContext,
	PSMgmtObject pMgmt = &(pDevice->sMgmtObj);		PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
	BYTE byData;		BYTE byData;


	// check if already in Doze mode		// check if already in Doze mode
	ControlvReadByte(pDevice, MESSAGE_REQUEST_MACREG, MAC_REG_PSCTL, &byData);		ControlvReadByte(pDevice, MESSAGE_REQUEST_MACREG,
			MAC_REG_PSCTL, &byData);

	if ( (byData & PSCTL_PS) != 0 )		if ( (byData & PSCTL_PS) != 0 )
	return TRUE;		return TRUE;

	@@ -212,16 +210,16 @@ BOOL PSbConsiderPowerDown(void *hDeviceContext,
	MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_PSEN);		MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_PSEN);

	if (pMgmt->eCurrMode != WMAC_MODE_IBSS_STA) {		if (pMgmt->eCurrMode != WMAC_MODE_IBSS_STA) {
	if (bCheckCountToWakeUp &&		if (bCheckCountToWakeUp && (pMgmt->wCountToWakeUp == 0
	(pMgmt->wCountToWakeUp == 0 \|\| pMgmt->wCountToWakeUp == 1)) {		\|\| pMgmt->wCountToWakeUp == 1)) {
	return FALSE;		return FALSE;
	}		}
	}		}

	pDevice->bPSRxBeacon = TRUE;		pDevice->bPSRxBeacon = TRUE;

	// no Tx, no Rx isr, now go to Doze		// no Tx, no Rx isr, now go to Doze
	MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_GO2DOZE);		MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_GO2DOZE);

	DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Go to Doze ZZZZZZZZZZZZZZZ\n");		DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Go to Doze ZZZZZZZZZZZZZZZ\n");
	return TRUE;		return TRUE;
	}		}
	@@ -242,7 +240,6 @@ void PSvSendPSPOLL(void *hDeviceContext)
	PSMgmtObject pMgmt = &(pDevice->sMgmtObj);		PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
	PSTxMgmtPacket pTxPacket = NULL;		PSTxMgmtPacket pTxPacket = NULL;


	memset(pMgmt->pbyPSPacketPool, 0, sizeof(STxMgmtPacket) + WLAN_HDR_ADDR2_LEN);		memset(pMgmt->pbyPSPacketPool, 0, sizeof(STxMgmtPacket) + WLAN_HDR_ADDR2_LEN);
	pTxPacket = (PSTxMgmtPacket)pMgmt->pbyPSPacketPool;		pTxPacket = (PSTxMgmtPacket)pMgmt->pbyPSPacketPool;
	pTxPacket->p80211Header = (PUWLAN_80211HDR)((PBYTE)pTxPacket + sizeof(STxMgmtPacket));		pTxPacket->p80211Header = (PUWLAN_80211HDR)((PBYTE)pTxPacket + sizeof(STxMgmtPacket));
	@@ -252,19 +249,19 @@ void PSvSendPSPOLL(void *hDeviceContext)
	WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_PSPOLL) \|		WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_PSPOLL) \|
	WLAN_SET_FC_PWRMGT(0)		WLAN_SET_FC_PWRMGT(0)
	));		));

	pTxPacket->p80211Header->sA2.wDurationID = pMgmt->wCurrAID \| BIT14 \| BIT15;		pTxPacket->p80211Header->sA2.wDurationID = pMgmt->wCurrAID \| BIT14 \| BIT15;
	memcpy(pTxPacket->p80211Header->sA2.abyAddr1, pMgmt->abyCurrBSSID, WLAN_ADDR_LEN);		memcpy(pTxPacket->p80211Header->sA2.abyAddr1, pMgmt->abyCurrBSSID, WLAN_ADDR_LEN);
	memcpy(pTxPacket->p80211Header->sA2.abyAddr2, pMgmt->abyMACAddr, WLAN_ADDR_LEN);		memcpy(pTxPacket->p80211Header->sA2.abyAddr2, pMgmt->abyMACAddr, WLAN_ADDR_LEN);
	pTxPacket->cbMPDULen = WLAN_HDR_ADDR2_LEN;		pTxPacket->cbMPDULen = WLAN_HDR_ADDR2_LEN;
	pTxPacket->cbPayloadLen = 0;		pTxPacket->cbPayloadLen = 0;

	// send the frame		// send the frame
	if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {		if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {
	DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send PS-Poll packet failed..\n");		DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send PS-Poll packet failed..\n");
	}		} else {
	else {
	// DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send PS-Poll packet success..\n");		// DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send PS-Poll packet success..\n");
	};		};

	return;		return;
	}		}

	@@ -284,8 +281,6 @@ BOOL PSbSendNullPacket(void *hDeviceContext)
	PSTxMgmtPacket pTxPacket = NULL;		PSTxMgmtPacket pTxPacket = NULL;
	PSMgmtObject pMgmt = &(pDevice->sMgmtObj);		PSMgmtObject pMgmt = &(pDevice->sMgmtObj);



	if (pDevice->bLinkPass == FALSE) {		if (pDevice->bLinkPass == FALSE) {
	return FALSE;		return FALSE;
	}		}
	@@ -300,15 +295,13 @@ BOOL PSbSendNullPacket(void *hDeviceContext)
	pTxPacket->p80211Header = (PUWLAN_80211HDR)((PBYTE)pTxPacket + sizeof(STxMgmtPacket));		pTxPacket->p80211Header = (PUWLAN_80211HDR)((PBYTE)pTxPacket + sizeof(STxMgmtPacket));

	if (pDevice->bEnablePSMode) {		if (pDevice->bEnablePSMode) {

	pTxPacket->p80211Header->sA3.wFrameCtl = cpu_to_le16(		pTxPacket->p80211Header->sA3.wFrameCtl = cpu_to_le16(
	(		(
	WLAN_SET_FC_FTYPE(WLAN_TYPE_DATA) \|		WLAN_SET_FC_FTYPE(WLAN_TYPE_DATA) \|
	WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_NULL) \|		WLAN_SET_FC_FSTYPE(WLAN_FSTYPE_NULL) \|
	WLAN_SET_FC_PWRMGT(1)		WLAN_SET_FC_PWRMGT(1)
	));		));
	}		} else {
	else {
	pTxPacket->p80211Header->sA3.wFrameCtl = cpu_to_le16(		pTxPacket->p80211Header->sA3.wFrameCtl = cpu_to_le16(
	(		(
	WLAN_SET_FC_FTYPE(WLAN_TYPE_DATA) \|		WLAN_SET_FC_FTYPE(WLAN_TYPE_DATA) \|
	@@ -330,12 +323,10 @@ BOOL PSbSendNullPacket(void *hDeviceContext)
	if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {		if (csMgmt_xmit(pDevice, pTxPacket) != CMD_STATUS_PENDING) {
	DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send Null Packet failed !\n");		DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send Null Packet failed !\n");
	return FALSE;		return FALSE;
	}		} else {
	else {
	// DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send Null Packet success....\n");		// DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Send Null Packet success....\n");
	}		}


	return TRUE ;		return TRUE ;
	}		}

	@@ -351,7 +342,6 @@ BOOL PSbSendNullPacket(void *hDeviceContext)

	BOOL PSbIsNextTBTTWakeUp(void *hDeviceContext)		BOOL PSbIsNextTBTTWakeUp(void *hDeviceContext)
	{		{

	PSDevice pDevice = (PSDevice)hDeviceContext;		PSDevice pDevice = (PSDevice)hDeviceContext;
	PSMgmtObject pMgmt = &(pDevice->sMgmtObj);		PSMgmtObject pMgmt = &(pDevice->sMgmtObj);
	BOOL bWakeUp = FALSE;		BOOL bWakeUp = FALSE;
	@@ -364,19 +354,15 @@ BOOL PSbIsNextTBTTWakeUp(void *hDeviceContext)
	pMgmt->wCountToWakeUp --;		pMgmt->wCountToWakeUp --;

	if (pMgmt->wCountToWakeUp == 1) {		if (pMgmt->wCountToWakeUp == 1) {

	// Turn on wake up to listen next beacon		// Turn on wake up to listen next beacon
	MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);		MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);
	pDevice->bPSRxBeacon = FALSE;		pDevice->bPSRxBeacon = FALSE;
	bWakeUp = TRUE;		bWakeUp = TRUE;

	} else if ( !pDevice->bPSRxBeacon ) {		} else if ( !pDevice->bPSRxBeacon ) {
	//Listen until RxBeacon		//Listen until RxBeacon
	MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);		MACvRegBitsOn(pDevice, MAC_REG_PSCTL, PSCTL_LNBCN);
	}		}

	}		}

	return bWakeUp;		return bWakeUp;
	}		}