static IMG_VOID SetDCState(IMG_HANDLE hDevice, IMG_UINT32 ui32State)
{
MTKLFB_DEVINFO *psDevInfo = (MTKLFB_DEVINFO *)hDevice;
switch (ui32State)
{
case DC_STATE_FLUSH_COMMANDS:
MTKLFBAtomicBoolSet(&psDevInfo->sFlushCommands, MTKLFB_TRUE);
break;
case DC_STATE_NO_FLUSH_COMMANDS:
MTKLFBAtomicBoolSet(&psDevInfo->sFlushCommands, MTKLFB_FALSE);
break;
default:
break;
}
}
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 int MTKLFBFrameBufferEvents(struct notifier_block *psNotif,
unsigned long event, void *data)
{
MTKLFB_DEVINFO *psDevInfo;
struct fb_event *psFBEvent = (struct fb_event *)data;
struct fb_info *psFBInfo = psFBEvent->info;
MTKLFB_BOOL bBlanked;
if (event != FB_EVENT_BLANK)
{
return 0;
}
bBlanked = (*(IMG_INT *)psFBEvent->data != 0) ? MTKLFB_TRUE: MTKLFB_FALSE;
psDevInfo = MTKLFBGetDevInfoPtr(psFBInfo->node);
#if 0
if (psDevInfo != NULL)
{
if (bBlanked)
{
DEBUG_PRINTK((KERN_INFO DRIVER_PREFIX ": %s: Device %u: Blank event received\n", __FUNCTION__, psDevInfo->uiFBDevID));
}
else
{
DEBUG_PRINTK((KERN_INFO DRIVER_PREFIX ": %s: Device %u: Unblank event received\n", __FUNCTION__, psDevInfo->uiFBDevID));
}
}
else
{
DEBUG_PRINTK((KERN_INFO DRIVER_PREFIX ": %s: Device %u: Blank/Unblank event for unknown framebuffer\n", __FUNCTION__, psFBInfo->node));
}
#endif
if (psDevInfo != NULL)
{
MTKLFBAtomicBoolSet(&psDevInfo->sBlanked, bBlanked);
MTKLFBAtomicIntInc(&psDevInfo->sBlankEvents);
}
return 0;
}
MTKLFB_ERROR MTKLFBDisableLFBEventNotification(MTKLFB_DEVINFO *psDevInfo)
{
int res;
#ifdef CONFIG_HAS_EARLYSUSPEND
unregister_early_suspend(&psDevInfo->sEarlySuspend);
#endif
res = fb_unregister_client(&psDevInfo->sLINNotifBlock);
if (res != 0)
{
printk(KERN_WARNING DRIVER_PREFIX
": %s: Device %u: fb_unregister_client failed (%d)\n", __FUNCTION__, psDevInfo->uiFBDevID, res);
return (MTKLFB_ERROR_GENERIC);
}
MTKLFBAtomicBoolSet(&psDevInfo->sBlanked, MTKLFB_FALSE);
return (MTKLFB_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;
}