enum PVRSRV_ERROR PVRSRVSetDevicePowerStateKM(u32 ui32DeviceIndex,
enum PVR_POWER_STATE eNewPowerState,
u32 ui32CallerID, IMG_BOOL bRetainMutex)
{
enum PVRSRV_ERROR eError;
struct SYS_DATA *psSysData;
eError = SysAcquireData(&psSysData);
if (eError != PVRSRV_OK)
return eError;
eError = PVRSRVPowerLock(ui32CallerID, IMG_FALSE);
if (eError != PVRSRV_OK)
return eError;
#if defined(PDUMP)
if (eNewPowerState == PVRSRV_POWER_Unspecified) {
eError =
PVRSRVDevicePrePowerStateKM(IMG_FALSE, ui32DeviceIndex,
PVRSRV_POWER_STATE_D0);
if (eError != PVRSRV_OK)
goto Exit;
eError =
PVRSRVDevicePostPowerStateKM(IMG_FALSE, ui32DeviceIndex,
PVRSRV_POWER_STATE_D0);
if (eError != PVRSRV_OK)
goto Exit;
PDUMPSUSPEND();
}
#endif
eError = PVRSRVDevicePrePowerStateKM(IMG_FALSE, ui32DeviceIndex,
eNewPowerState);
if (eError != PVRSRV_OK) {
if (eNewPowerState == PVRSRV_POWER_Unspecified)
PDUMPRESUME();
goto Exit;
}
eError = PVRSRVDevicePostPowerStateKM(IMG_FALSE, ui32DeviceIndex,
eNewPowerState);
if (eNewPowerState == PVRSRV_POWER_Unspecified)
PDUMPRESUME();
Exit:
if (eError != PVRSRV_OK) {
PVR_DPF(PVR_DBG_ERROR, "PVRSRVSetDevicePowerStateKM : "
"Transition to %d FAILED 0x%x",
eNewPowerState, eError);
}
if (!bRetainMutex || (eError != PVRSRV_OK))
PVRSRVPowerUnlock(ui32CallerID);
return eError;
}
PVRSRV_ERROR PVRSRVSetDevicePowerStateCoreKM(IMG_UINT32 ui32DeviceIndex,
PVRSRV_DEV_POWER_STATE eNewPowerState)
{
PVRSRV_ERROR eError;
eError = PVRSRVDevicePrePowerStateKM(IMG_FALSE, ui32DeviceIndex, eNewPowerState);
if(eError != PVRSRV_OK)
{
return eError;
}
eError = PVRSRVDevicePostPowerStateKM(IMG_FALSE, ui32DeviceIndex, eNewPowerState);
return eError;
}
enum PVRSRV_ERROR PVRSRVSystemPrePowerStateKM(
enum PVR_POWER_STATE eNewPowerState)
{
enum PVRSRV_ERROR eError;
struct SYS_DATA *psSysData;
enum PVR_POWER_STATE eNewDevicePowerState;
eError = SysAcquireData(&psSysData);
if (eError != PVRSRV_OK)
return eError;
eError = PVRSRVPowerLock(KERNEL_ID, IMG_TRUE);
if (eError != PVRSRV_OK)
return eError;
if (_IsSystemStatePowered(eNewPowerState) !=
_IsSystemStatePowered(psSysData->eCurrentPowerState)) {
if (_IsSystemStatePowered(eNewPowerState))
eNewDevicePowerState = PVRSRV_POWER_Unspecified;
else
eNewDevicePowerState = PVRSRV_POWER_STATE_D3;
eError = PVRSRVDevicePrePowerStateKM(IMG_TRUE, 0,
eNewDevicePowerState);
if (eError != PVRSRV_OK)
goto ErrorExit;
}
if (eNewPowerState != psSysData->eCurrentPowerState) {
eError = SysSystemPrePowerState(eNewPowerState);
if (eError != PVRSRV_OK)
goto ErrorExit;
}
return eError;
ErrorExit:
PVR_DPF(PVR_DBG_ERROR, "PVRSRVSystemPrePowerStateKM: "
"Transition from %d to %d FAILED 0x%x",
psSysData->eCurrentPowerState, eNewPowerState, eError);
psSysData->eFailedPowerState = eNewPowerState;
PVRSRVPowerUnlock(KERNEL_ID);
return eError;
}
/*!
******************************************************************************
@Function PVRSRVSetPowerStateKM
@Description Set the system into a new state
@Input eNewPowerState :
@Input bForced : TRUE if the transition should not fail (e.g. OS request)
@Return PVRSRV_ERROR
******************************************************************************/
IMG_EXPORT
PVRSRV_ERROR PVRSRVSetPowerStateKM(PVRSRV_SYS_POWER_STATE eNewSysPowerState, IMG_BOOL bForced)
{
PVRSRV_ERROR eError;
PVRSRV_DATA *psPVRSRVData = PVRSRVGetPVRSRVData();
IMG_UINT uiStage = 0;
PVRSRV_DEV_POWER_STATE eNewDevicePowerState =
_IsSystemStatePowered(eNewSysPowerState)? PVRSRV_DEV_POWER_STATE_DEFAULT : PVRSRV_DEV_POWER_STATE_OFF;
/* require a proper power state */
if (eNewSysPowerState == PVRSRV_SYS_POWER_STATE_Unspecified)
{
return PVRSRV_ERROR_INVALID_PARAMS;
}
/* no power transition requested, so do nothing */
if (eNewSysPowerState == psPVRSRVData->eCurrentPowerState)
{
return PVRSRV_OK;
}
/* Prevent simultaneous SetPowerStateKM calls */
PVRSRVForcedPowerLock();
/* Perform pre transitions: first device and then sys layer */
eError = PVRSRVDevicePrePowerStateKM(IMG_TRUE, 0, eNewDevicePowerState, bForced);
if (eError != PVRSRV_OK)
{
uiStage++;
goto ErrorExit;
}
eError = PVRSRVSysPrePowerState(eNewSysPowerState, bForced);
if (eError != PVRSRV_OK)
{
uiStage++;
goto ErrorExit;
}
/* Perform system-specific post power transitions: first sys layer and then device */
eError = PVRSRVSysPostPowerState(eNewSysPowerState, bForced);
if (eError != PVRSRV_OK)
{
uiStage++;
goto ErrorExit;
}
eError = PVRSRVDevicePostPowerStateKM(IMG_TRUE, 0, eNewDevicePowerState, bForced);
if (eError != PVRSRV_OK)
{
uiStage++;
goto ErrorExit;
}
psPVRSRVData->eCurrentPowerState = eNewSysPowerState;
psPVRSRVData->eFailedPowerState = PVRSRV_SYS_POWER_STATE_Unspecified;
PVRSRVPowerUnlock();
/*
Reprocess the devices' queues in case commands were blocked during
the power transition.
*/
if (_IsSystemStatePowered(eNewSysPowerState) &&
PVRSRVGetInitServerState(PVRSRV_INIT_SERVER_SUCCESSFUL))
{
PVRSRVCheckStatus(IMG_NULL);
}
return PVRSRV_OK;
ErrorExit:
/* save the power state for the re-attempt */
psPVRSRVData->eFailedPowerState = eNewSysPowerState;
PVRSRVPowerUnlock();
PVR_DPF((PVR_DBG_ERROR,
"PVRSRVSetPowerStateKM: Transition from %d to %d FAILED (%s) at stage %d, forced: %d. Dumping debug info.",
psPVRSRVData->eCurrentPowerState, eNewSysPowerState, PVRSRVGetErrorStringKM(eError), uiStage, bForced));
PVRSRVDebugRequest(DEBUG_REQUEST_VERBOSITY_MAX);
return eError;
}
/*!
******************************************************************************
@Function PVRSRVSetDevicePowerStateKM
@Description Set the Device into a new state
@Input ui32DeviceIndex : device index
@Input eNewPowerState : New power state
@Input bForced : TRUE if the transition should not fail (e.g. OS request)
@Return PVRSRV_ERROR
******************************************************************************/
IMG_EXPORT
PVRSRV_ERROR PVRSRVSetDevicePowerStateKM(IMG_UINT32 ui32DeviceIndex,
PVRSRV_DEV_POWER_STATE eNewPowerState,
IMG_BOOL bForced)
{
PVRSRV_DATA* psPVRSRVData = PVRSRVGetPVRSRVData();
PVRSRV_ERROR eError;
PVRSRV_DEV_POWER_STATE eOldPowerState;
eError = PVRSRVGetDevicePowerState(ui32DeviceIndex, &eOldPowerState);
if (eError != PVRSRV_OK)
{
PVR_DPF((PVR_DBG_WARNING, "PVRSRVSetDevicePowerStateKM: Couldn't read power state."));
eOldPowerState = PVRSRV_DEV_POWER_STATE_DEFAULT;
}
#if defined(PDUMP)
if (eNewPowerState == PVRSRV_DEV_POWER_STATE_DEFAULT)
{
/*
Pdump a power-up regardless of the default state.
Then disable pdump and transition to the default power state.
This ensures that a power-up is always present in the pdump when necessary.
*/
eError = PVRSRVDevicePrePowerStateKM(IMG_FALSE, ui32DeviceIndex, PVRSRV_DEV_POWER_STATE_ON, bForced);
if(eError != PVRSRV_OK)
{
goto Exit;
}
eError = PVRSRVDevicePostPowerStateKM(IMG_FALSE, ui32DeviceIndex, PVRSRV_DEV_POWER_STATE_ON, bForced);
if (eError != PVRSRV_OK)
{
goto Exit;
}
PDUMPPOWCMDSTART();
}
#endif /* PDUMP */
eError = PVRSRVDevicePrePowerStateKM(IMG_FALSE, ui32DeviceIndex, eNewPowerState, bForced);
if(eError != PVRSRV_OK)
{
if (eNewPowerState == PVRSRV_DEV_POWER_STATE_DEFAULT)
{
PDUMPPOWCMDEND();
}
goto Exit;
}
eError = PVRSRVDevicePostPowerStateKM(IMG_FALSE, ui32DeviceIndex, eNewPowerState, bForced);
if (eNewPowerState == PVRSRV_DEV_POWER_STATE_DEFAULT)
{
PDUMPPOWCMDEND();
}
/* Signal Device Watchdog Thread about power mode change. */
if (eOldPowerState != eNewPowerState && eNewPowerState == PVRSRV_DEV_POWER_STATE_ON)
{
psPVRSRVData->ui32DevicesWatchdogPwrTrans++;
if (psPVRSRVData->ui32DevicesWatchdogTimeout == DEVICES_WATCHDOG_POWER_OFF_SLEEP_TIMEOUT)
{
if (psPVRSRVData->hDevicesWatchdogEvObj)
{
eError = OSEventObjectSignal(psPVRSRVData->hDevicesWatchdogEvObj);
PVR_LOG_IF_ERROR(eError, "OSEventObjectSignal");
}
}
}
Exit:
if (eError == PVRSRV_ERROR_DEVICE_POWER_CHANGE_DENIED)
{
PVR_DPF((PVR_DBG_MESSAGE,
"PVRSRVSetDevicePowerStateKM : Transition to %d was denied, Forced=%d", eNewPowerState, bForced));
}
else if(eError != PVRSRV_OK)
{
PVR_DPF((PVR_DBG_WARNING,
"PVRSRVSetDevicePowerStateKM : Transition to %d FAILED (%s)", eNewPowerState, PVRSRVGetErrorStringKM(eError)));
}
return eError;
}
IMG_EXPORT
PVRSRV_ERROR PVRSRVSystemPrePowerStateKM(PVRSRV_SYS_POWER_STATE eNewSysPowerState)
{
PVRSRV_ERROR eError;
SYS_DATA *psSysData;
PVRSRV_DEV_POWER_STATE eNewDevicePowerState;
SysAcquireData(&psSysData);
eError = PVRSRVPowerLock(KERNEL_ID, IMG_TRUE);
if(eError != PVRSRV_OK)
{
return eError;
}
if (_IsSystemStatePowered(eNewSysPowerState) !=
_IsSystemStatePowered(psSysData->eCurrentPowerState))
{
if (_IsSystemStatePowered(eNewSysPowerState))
{
eNewDevicePowerState = PVRSRV_DEV_POWER_STATE_DEFAULT;
}
else
{
eNewDevicePowerState = PVRSRV_DEV_POWER_STATE_OFF;
}
eError = PVRSRVDevicePrePowerStateKM(IMG_TRUE, 0, eNewDevicePowerState);
if (eError != PVRSRV_OK)
{
goto ErrorExit;
}
}
if (eNewSysPowerState != psSysData->eCurrentPowerState)
{
eError = SysSystemPrePowerState(eNewSysPowerState);
if (eError != PVRSRV_OK)
{
goto ErrorExit;
}
}
return eError;
ErrorExit:
PVR_DPF((PVR_DBG_ERROR,
"PVRSRVSystemPrePowerStateKM: Transition from %d to %d FAILED 0x%x",
psSysData->eCurrentPowerState, eNewSysPowerState, eError));
psSysData->eFailedPowerState = eNewSysPowerState;
PVRSRVPowerUnlock(KERNEL_ID);
return eError;
}
IMG_EXPORT
PVRSRV_ERROR PVRSRVSetDevicePowerStateKM(IMG_UINT32 ui32DeviceIndex,
PVRSRV_DEV_POWER_STATE eNewPowerState,
IMG_UINT32 ui32CallerID,
IMG_BOOL bRetainMutex)
{
PVRSRV_ERROR eError;
SYS_DATA *psSysData;
SysAcquireData(&psSysData);
eError = PVRSRVPowerLock(ui32CallerID, IMG_FALSE);
if(eError != PVRSRV_OK)
{
return eError;
}
#if defined(PDUMP)
if (eNewPowerState == PVRSRV_DEV_POWER_STATE_DEFAULT)
{
eError = PVRSRVDevicePrePowerStateKM(IMG_FALSE, ui32DeviceIndex, PVRSRV_DEV_POWER_STATE_ON);
if(eError != PVRSRV_OK)
{
goto Exit;
}
eError = PVRSRVDevicePostPowerStateKM(IMG_FALSE, ui32DeviceIndex, PVRSRV_DEV_POWER_STATE_ON);
if (eError != PVRSRV_OK)
{
goto Exit;
}
PDUMPSUSPEND();
}
#endif
eError = PVRSRVDevicePrePowerStateKM(IMG_FALSE, ui32DeviceIndex, eNewPowerState);
if(eError != PVRSRV_OK)
{
if (eNewPowerState == PVRSRV_DEV_POWER_STATE_DEFAULT)
{
PDUMPRESUME();
}
goto Exit;
}
eError = PVRSRVDevicePostPowerStateKM(IMG_FALSE, ui32DeviceIndex, eNewPowerState);
if (eNewPowerState == PVRSRV_DEV_POWER_STATE_DEFAULT)
{
PDUMPRESUME();
}
Exit:
if(eError != PVRSRV_OK)
{
PVR_DPF((PVR_DBG_ERROR,
"PVRSRVSetDevicePowerStateKM : Transition to %d FAILED 0x%x", eNewPowerState, eError));
}
if (!bRetainMutex || (eError != PVRSRV_OK))
{
PVRSRVPowerUnlock(ui32CallerID);
}
return eError;
}
