static PVRSRV_ERROR CloseDCDevice(IMG_HANDLE hDevice)
{
#if defined(SUPPORT_DRI_DRM)
MTKLFB_DEVINFO *psDevInfo = (MTKLFB_DEVINFO *)hDevice;
MTKLFBAtomicBoolSet(&psDevInfo->sLeaveVT, MTKLFB_FALSE);
(void) MTKLFBUnblankDisplay(psDevInfo);
#else
UNREFERENCED_PARAMETER(hDevice);
#endif
return PVRSRV_OK;
}
static void MTKLFBEarlyResumeHandler(struct early_suspend *h)
{
unsigned uiMaxFBDevIDPlusOne = MTKLFBMaxFBDevIDPlusOne();
unsigned i;
for (i=0; i < uiMaxFBDevIDPlusOne; i++)
{
MTKLFB_DEVINFO *psDevInfo = MTKLFBGetDevInfoPtr(i);
if (psDevInfo != NULL)
{
MTKLFBUnblankDisplay(psDevInfo);
MTKLFBAtomicBoolSet(&psDevInfo->sEarlySuspendFlag, MTKLFB_FALSE);
}
}
}
static PVRSRV_ERROR OpenDCDevice(IMG_UINT32 uiPVRDevID,
IMG_HANDLE *phDevice,
PVRSRV_SYNC_DATA* psSystemBufferSyncData)
{
MTKLFB_DEVINFO *psDevInfo;
MTKLFB_ERROR eError;
unsigned uiMaxFBDevIDPlusOne = MTKLFBMaxFBDevIDPlusOne();
unsigned i;
for (i = 0; i < uiMaxFBDevIDPlusOne; i++)
{
psDevInfo = MTKLFBGetDevInfoPtr(i);
if (psDevInfo != NULL && psDevInfo->uiPVRDevID == uiPVRDevID)
{
break;
}
}
if (i == uiMaxFBDevIDPlusOne)
{
DEBUG_PRINTK((KERN_WARNING DRIVER_PREFIX
": %s: PVR Device %u not found\n", __FUNCTION__, uiPVRDevID));
return PVRSRV_ERROR_INVALID_DEVICE;
}
psDevInfo->sSystemBuffer.psSyncData = psSystemBufferSyncData;
eError = MTKLFBUnblankDisplay(psDevInfo);
if (eError != MTKLFB_OK)
{
DEBUG_PRINTK((KERN_WARNING DRIVER_PREFIX
": %s: Device %u: MTKLFBUnblankDisplay failed (%d)\n", __FUNCTION__, psDevInfo->uiFBDevID, eError));
return PVRSRV_ERROR_UNBLANK_DISPLAY_FAILED;
}
*phDevice = (IMG_HANDLE)psDevInfo;
return PVRSRV_OK;
}
MTKLFB_ERROR MTKLFBEnableLFBEventNotification(MTKLFB_DEVINFO *psDevInfo)
{
int res;
MTKLFB_ERROR eError;
memset(&psDevInfo->sLINNotifBlock, 0, sizeof(psDevInfo->sLINNotifBlock));
psDevInfo->sLINNotifBlock.notifier_call = MTKLFBFrameBufferEvents;
MTKLFBAtomicBoolSet(&psDevInfo->sBlanked, MTKLFB_FALSE);
MTKLFBAtomicIntSet(&psDevInfo->sBlankEvents, 0);
res = fb_register_client(&psDevInfo->sLINNotifBlock);
if (res != 0)
{
printk(KERN_WARNING DRIVER_PREFIX
": %s: Device %u: fb_register_client failed (%d)\n", __FUNCTION__, psDevInfo->uiFBDevID, res);
return (MTKLFB_ERROR_GENERIC);
}
eError = MTKLFBUnblankDisplay(psDevInfo);
if (eError != MTKLFB_OK)
{
printk(KERN_WARNING DRIVER_PREFIX
": %s: Device %u: UnblankDisplay failed (%d)\n", __FUNCTION__, psDevInfo->uiFBDevID, eError);
return eError;
}
#ifdef CONFIG_HAS_EARLYSUSPEND
psDevInfo->sEarlySuspend.suspend = MTKLFBEarlySuspendHandler;
psDevInfo->sEarlySuspend.resume = MTKLFBEarlyResumeHandler;
psDevInfo->sEarlySuspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN;
register_early_suspend(&psDevInfo->sEarlySuspend);
#endif
return (MTKLFB_OK);
}
int PVR_DRM_MAKENAME(DISPLAY_CONTROLLER, _Ioctl)(struct drm_device unref__ *dev, void *arg, struct drm_file unref__ *pFile)
{
uint32_t *puiArgs;
uint32_t uiCmd;
unsigned uiPVRDevID;
int ret = 0;
MTKLFB_DEVINFO *psDevInfo;
if (arg == NULL)
{
return -EFAULT;
}
puiArgs = (uint32_t *)arg;
uiCmd = puiArgs[PVR_DRM_DISP_ARG_CMD];
uiPVRDevID = puiArgs[PVR_DRM_DISP_ARG_DEV];
psDevInfo = MTKLFBPVRDevIDToDevInfo(uiPVRDevID);
if (psDevInfo == NULL)
{
return -EINVAL;
}
switch (uiCmd)
{
case PVR_DRM_DISP_CMD_LEAVE_VT:
case PVR_DRM_DISP_CMD_ENTER_VT:
{
MTKLFB_BOOL bLeaveVT = (uiCmd == PVR_DRM_DISP_CMD_LEAVE_VT);
DEBUG_PRINTK((KERN_WARNING DRIVER_PREFIX ": %s: PVR Device %u: %s\n",
__FUNCTION__, uiPVRDevID,
bLeaveVT ? "Leave VT" : "Enter VT"));
MTKLFBCreateSwapChainLock(psDevInfo);
MTKLFBAtomicBoolSet(&psDevInfo->sLeaveVT, bLeaveVT);
if (psDevInfo->psSwapChain != NULL)
{
flush_workqueue(psDevInfo->psSwapChain->psWorkQueue);
if (bLeaveVT)
{
MTKLFBFlip(psDevInfo, &psDevInfo->sSystemBuffer);
(void) MTKLFBCheckModeAndSync(psDevInfo);
}
}
MTKLFBCreateSwapChainUnLock(psDevInfo);
(void) MTKLFBUnblankDisplay(psDevInfo);
break;
}
case PVR_DRM_DISP_CMD_ON:
case PVR_DRM_DISP_CMD_STANDBY:
case PVR_DRM_DISP_CMD_SUSPEND:
case PVR_DRM_DISP_CMD_OFF:
{
int iFBMode;
#if defined(DEBUG)
{
const char *pszMode;
switch(uiCmd)
{
case PVR_DRM_DISP_CMD_ON:
pszMode = "On";
break;
case PVR_DRM_DISP_CMD_STANDBY:
pszMode = "Standby";
break;
case PVR_DRM_DISP_CMD_SUSPEND:
pszMode = "Suspend";
break;
case PVR_DRM_DISP_CMD_OFF:
pszMode = "Off";
break;
default:
pszMode = "(Unknown Mode)";
break;
}
printk (KERN_WARNING DRIVER_PREFIX ": %s: PVR Device %u: Display %s\n",
__FUNCTION__, uiPVRDevID, pszMode);
}
#endif
switch(uiCmd)
{
case PVR_DRM_DISP_CMD_ON:
iFBMode = FB_BLANK_UNBLANK;
break;
case PVR_DRM_DISP_CMD_STANDBY:
iFBMode = FB_BLANK_HSYNC_SUSPEND;
break;
case PVR_DRM_DISP_CMD_SUSPEND:
iFBMode = FB_BLANK_VSYNC_SUSPEND;
break;
case PVR_DRM_DISP_CMD_OFF:
iFBMode = FB_BLANK_POWERDOWN;
break;
default:
return -EINVAL;
}
MTKLFBCreateSwapChainLock(psDevInfo);
if (psDevInfo->psSwapChain != NULL)
{
flush_workqueue(psDevInfo->psSwapChain->psWorkQueue);
}
acquire_console_sem();
ret = fb_blank(psDevInfo->psLINFBInfo, iFBMode);
release_console_sem();
MTKLFBCreateSwapChainUnLock(psDevInfo);
break;
}
default:
{
ret = -EINVAL;
break;
}
}
return ret;
}
