/*****************************************************************************\ * * Filename: movie.c * * Description: Media Plug PCMCIA card client driver for WinCE. * * * Original author: Arnaud Glatron - Barbara Trzebowski * * Copyright (c) Winnov L.P., 1997 * All Rights Reserved. * \*****************************************************************************/ #include #include #include #include #include #include //for memcpy #include "hadshr.h" #include "movie.h" #include "private.h" #include "Init.h" #include "miniHAL.h" #include "wnv1dib.h" #include "caviario.h" ///////////////////////////////////////////////////////// // // Global variables... // ///////////////////////////////////////////////////////// #define WM_POWERBROADCAST 0x0218 #ifdef _DEBUG TCHAR cDebugBuf[256]; #endif static DWORD glb_Marker[4] = {0xFFFFFFFF,0xFFFFFFFF,0xFFFFFFFF,0xFFFFFFFF,}; static DWORD glb_count=0; ///////////////////////////////////////////////////////// // // LOCAL functions... // ///////////////////////////////////////////////////////// /*****************************************************************************\ * * Module Name: Local_ReadVideo * * Description: This routine reads a user specified size of video * from the SRAM memory into the user buffer. * * Return: BOOL * * \*****************************************************************************/ BOOL Local_ReadVideo(IN PCLIENT_CONTEXT pcc, IN HWCMD_READ_VIDEO_HDR_TYPE readVideoInfo, OUT BYTE *pbyBuffer, OUT DWORD *pActualBytesRead) { BYTE *pbyCurrBufPos; DWORD dwDataPerLine = 0; UINT i; WORD usSRAMAddr; BOOL bFound = FALSE; BYTE *pTempBuf; BOOL bstatus = TRUE; DWORD dwCurrSramAddr; pbyCurrBufPos = pbyBuffer; *pActualBytesRead = 0; // Read all lines but 1st set up the host pointer. // The last 4 bit of address is auto-incrementing. usSRAMAddr = (WORD)(readVideoInfo.dwSramAddr >> 4); bstatus = WriteWordReg(pcc,CIO_HSTPTR, usSRAMAddr); dwCurrSramAddr = readVideoInfo.dwSramAddr; if (!bstatus) { return (bstatus); } if (readVideoInfo.dwCompressFlags & COMP_FLAGS_HUFFMAN) { // Compression. Keep reading until the end marker // is reached. while ( !bFound && (*pActualBytesRead + 1024 <= readVideoInfo.dwBufSize) ) { // Let's read 1K at a time and look for the end marker bstatus = ReadStream(pcc,CIO_HSTDAT,(PDWORD)pbyCurrBufPos,1024); // Try to filter out eeeeeeeee bug. It seems to only happen // when the timeout bit is set. if (!bstatus) { // Retry the same read again bstatus = WriteWordReg(pcc,CIO_HSTPTR, usSRAMAddr); bstatus = ReadStream(pcc,CIO_HSTDAT,(PDWORD)pbyCurrBufPos,1024); } if (!bstatus) { // Abort reading this frame *pActualBytesRead = (DWORD)HADSHR_ERR_DATA_CORRUPTION; return (bstatus); } *pActualBytesRead = *pActualBytesRead + 1024; if ( memcmp(pbyCurrBufPos + 1024 - sizeof(glb_Marker), glb_Marker, sizeof(glb_Marker)) == 0 ) { // Replace the marker with all 0's, this gives // the decompressor more huffman codes on error memset(pbyCurrBufPos + 1024 - sizeof(glb_Marker), 0, sizeof(glb_Marker)); bFound = TRUE; } else { pbyCurrBufPos += 1024; // Must also reset the host pointer because media-plug // prefetches data in stream read (i.e. host pointer updated), // so the host pointer will be 4 bytes off on the subsequent read dwCurrSramAddr += 1024; usSRAMAddr = (WORD)(dwCurrSramAddr >> 4); bstatus = WriteWordReg(pcc,CIO_HSTPTR, usSRAMAddr); if (!bstatus) { *pActualBytesRead = (DWORD)HADSHR_ERR_DATA_CORRUPTION; return (bstatus); } } } if (!bFound) { if (bstatus) { // Caller should inteprete it as a full buffer // of data has been read and no marker was found *pActualBytesRead = HADSHR_ERR_DATA_OVERFLOW; } else { *pActualBytesRead = (DWORD)HADSHR_ERR_DATA_CORRUPTION; } } } else // YCH(YUY2) or YCQ(fall back mode if cannot readout using delta huffman) { // YUY2 is 2 bytes per pixel. for YCQ we are // reading out at 1/2 resolution, therefore 1 bytes per pixel if (readVideoInfo.dwCompressFlags & COMP_FLAGS_FORMAT_YCH) { dwDataPerLine = readVideoInfo.nWidth * 2; } else { dwDataPerLine = readVideoInfo.nWidth; } // If mirror Y bit is not set then we must flip the // image to the upright position. if (!(readVideoInfo.dwFormatFlags & FMT_MIRRORY)) { // To save number of HAL calls, read the image one shot // upside down then flip it afterward pTempBuf= (BYTE *) LocalAlloc(LPTR, readVideoInfo.dwBufSize); if(!pTempBuf) //can't allocate buffer! { *pActualBytesRead = 0; //can't read! return FALSE; } bstatus=ReadStream(pcc,CIO_HSTDAT,(PDWORD)pTempBuf,readVideoInfo.dwBufSize); if (!bstatus) { // Retry the same read again bstatus = WriteWordReg(pcc,CIO_HSTPTR, usSRAMAddr); bstatus = ReadStream(pcc,CIO_HSTDAT,(PDWORD)pTempBuf,readVideoInfo.dwBufSize); } if (bstatus) { pbyCurrBufPos = pbyBuffer + readVideoInfo.dwBufSize; for (i = 0; i < readVideoInfo.nHeight; i++) { pbyCurrBufPos = pbyCurrBufPos - dwDataPerLine; memcpy(pbyCurrBufPos,pTempBuf+(i * dwDataPerLine),(size_t)dwDataPerLine); } } LocalFree(pTempBuf); } else { // Image already upside down bstatus =ReadStream(pcc,CIO_HSTDAT,(PDWORD)pbyBuffer,readVideoInfo.dwBufSize); if (!bstatus) { // Retry the same read again bstatus = WriteWordReg(pcc,CIO_HSTPTR, usSRAMAddr); bstatus = ReadStream(pcc,CIO_HSTDAT, (PDWORD)pbyBuffer,readVideoInfo.dwBufSize); } } if (!bstatus) { *pActualBytesRead = (DWORD)HADSHR_ERR_DATA_CORRUPTION; } else { *pActualBytesRead = readVideoInfo.dwBufSize / sizeof(DWORD); //???num of DWORD??? } } return (bstatus); } // Local_ReadVideo ///////////////////////////////////////////////////////// // // Stream Interface! // ///////////////////////////////////////////////////////// DWORD VID_Init(DWORD dwContext, DWORD dwClientContext) { PCLIENT_CONTEXT pcc = NULL; #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_Init().\r\n")); #endif // Allocate client context structure (cleared to zeros). pcc = (PCLIENT_CONTEXT) LocalAlloc(LPTR, sizeof(CLIENT_CONTEXT)); if (!pcc) { #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_Init(): failed to alloc.\r\n")); #endif return 0; } pcc->bResetCamera=FALSE; //initialize! //initialize type... if (!DetectHardware(dwContext, pcc)) // never fails { #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_Init(): failed to detect hardware.\r\n")); #endif pcc->bPhysAddrFound=FALSE; wcscpy(pcc->lptzSavedContext, (LPTSTR)dwContext); #ifdef WINNOV_PCMCIA if (pcc) LocalFree(pcc); return 0; #endif return (DWORD) pcc; } else { pcc->bPhysAddrFound=TRUE; //initialize Client Context... pcc->bCardPresent=TRUE; pcc->bInitialized=FALSE; // Initialize critical sections, set socket handle. InitializeCriticalSection(&(pcc->ioCritSect)); if (InitHardwareContext(dwContext, pcc)) // Good return { #ifdef _DEBUG BlinkLight(pcc); //Blink the Camera light if it is connected #endif return (DWORD) pcc; } else // Error return. { if (pcc) LocalFree(pcc); return 0; } } } //------------------------------------------------------------------------------ BOOL ReInit(DWORD dwContext, PCLIENT_CONTEXT pcc) //called by open in the case of a legacy driver! { #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: ReInit().\r\n")); #endif if (!DetectHardware(dwContext, pcc)) { #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: ReInit(): failed to redetect hardware.\r\n")); #endif return FALSE; } //initialize Client Context... pcc->bCardPresent=TRUE; pcc->bInitialized=FALSE; // Initialize critical sections, set socket handle. InitializeCriticalSection(&(pcc->ioCritSect)); if (InitHardwareContext(dwContext, pcc)) // Good return { #ifdef _DEBUG BlinkLight(pcc); //Blink the Camera light if it is connected #endif return TRUE; } else // Error return. { return FALSE; } } //------------------------------------------------------------------------------ BOOL VID_Deinit(DWORD dwClientContext) { PCLIENT_CONTEXT pcc = (PCLIENT_CONTEXT)dwClientContext; #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_Deinit().\r\n")); #endif PowerOff(pcc); //Turn off the camera! DeInitHardwareContext(pcc); // Free the client context. if (pcc) LocalFree(pcc); return TRUE; } //------------------------------------------------------------------------------ DWORD VID_Open(DWORD dwClientContext, DWORD dwAccess, DWORD dwShareMode) { POPEN_CONTEXT poc = NULL; #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_Open().\r\n")); #endif // Allocate open context structure (cleared to zeros). poc = (POPEN_CONTEXT) LocalAlloc(LPTR, sizeof(OPEN_CONTEXT)); if (!poc) { #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_Open(): failed to alloc.\r\n")); #endif goto erropret; } // Use client context as open context. poc->pClientContext= (PCLIENT_CONTEXT) dwClientContext; // check if H/W was correctly detected if (!poc->pClientContext->bPhysAddrFound) // then we need to reread the H/W { if (!ReInit((DWORD)poc->pClientContext->lptzSavedContext, poc->pClientContext)) { #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: Reinit(): Cannot initialize MediaPlug\r\n")); #endif goto erropret; } } if(!poc->pClientContext->bInitialized) { if(!InitializeInterface(poc->pClientContext)) //initialize the mediaPlug HostInterface { #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_Open(): Cannot initialize MediaPlug\r\n")); #endif goto erropret; } } if(!IsCameraConnected(poc->pClientContext)) //check for the camera being plugged in! { #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_Open(): Camera is not connected\r\n")); #endif goto erropret; } if(!poc->pClientContext->bInitialized) { PowerOn(poc->pClientContext); //turn on power to camera! if(!ResetCamera(poc->pClientContext)) //Reset camera, initialize camera clocks, memory, // and basic settings. After this,the camera is // ready for high level accesses! { #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_Open(): Cannot initialize camera\r\n")); #endif goto erropret; } } glb_count++; return (DWORD) poc; erropret: if (poc) LocalFree(poc); return 0; } //------------------------------------------------------------------------------ BOOL VID_Close(DWORD dwOpenContext) { POPEN_CONTEXT poc = (POPEN_CONTEXT)dwOpenContext; #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_Close().\r\n")); #endif if((--glb_count)==0) { PowerOff(poc->pClientContext); //Turn off the camera! } LocalFree(poc); return TRUE; } //------------------------------------------------------------------------------ DWORD VID_Read(DWORD dwOpenContext, LPVOID pBuffer, DWORD dwNumBytes) { return -1; // error. Use DeviceIOControl not ReadFile... } //------------------------------------------------------------------------------ DWORD VID_Write(DWORD dwOpenContext, LPCVOID pBuffer, DWORD dwNumBytes) { return -1; // error. Use DeviceIOControl not WriteFile... } //------------------------------------------------------------------------------ DWORD VID_Seek(DWORD dwOpenContext, long lDistance, DWORD dwMoveMethod) { return -1; //error. We do not support Seek! } //------------------------------------------------------------------------------ BOOL VID_IOControl(DWORD dwOpenContext, DWORD dwIoControlCode, PBYTE pInBuf, DWORD nInBufSize, PBYTE pOutBuf, DWORD nOutBufSize, PDWORD pBytesReturned) { PCLIENT_CONTEXT pcc = ((POPEN_CONTEXT)dwOpenContext)->pClientContext; DWORD dwNumBytes; BOOL bretval=FALSE; #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: VID_IOControl().\r\n")); #endif // Disallow concurrent ioctl's. EnterCriticalSection(&pcc->ioCritSect); if (pcc->bResetCamera) { pcc->bResetCamera=FALSE; InitializeInterface(pcc); //initialize the mediaPlug HostInterface GoHardware(pcc); } // Switch on IO control code. switch (dwIoControlCode) { case IOCTL_HWCMD_READ_REG: if ((!pInBuf) || (nInBufSize < sizeof(HWCMD_INPUT_HEADER_TYPE)) || (!pOutBuf) || (nOutBufSize < sizeof(WORD))) //null buffer or wrong buffer sizes bretval=FALSE; else { if (!GoHardware(pcc)) bretval=FALSE; //no camera or card! fail! else { bretval = ReadWordReg(pcc, (WORD)((PHWCMD_INPUT_HEADER_TYPE)pInBuf)->hdr.ReadRegister, (PWORD)pOutBuf); *pBytesReturned= sizeof (WORD); } } if (!bretval) { *pBytesReturned = 0; //we failed to read! } break; case IOCTL_HWCMD_WRITE_REG: if ((!pInBuf) || (nInBufSize < sizeof(HWCMD_INPUT_HEADER_TYPE))) //null buffer or wrong buffer size bretval=FALSE; else { if (!GoHardware(pcc)) bretval=FALSE; //no camera or card! fail! else { bretval = WriteWordReg(pcc, ((PHWCMD_INPUT_HEADER_TYPE)pInBuf)->hdr.WriteRegStruct.wRegister, ((PHWCMD_INPUT_HEADER_TYPE)pInBuf)->hdr.WriteRegStruct.wValue); } } *pBytesReturned = 0; //we did not read anything!!! break; case IOCTL_HWCMD_START_HW: case IOCTL_HWCMD_PWR_ON_HW: bretval=GoHardware(pcc); //reinitialize or fail! *pBytesReturned = 0; break; case IOCTL_HWCMD_STOP_HW: case IOCTL_HWCMD_PWR_OFF_HW: PowerOff(pcc); //turn power off! bretval=TRUE; *pBytesReturned = 0; break; case IOCTL_HWCMD_PROCESS_COMMAND_QUEUE: bretval=FALSE; //not supported anymore... Memory mapping between process spaces is an issue! break; case IOCTL_HWCMD_READ_VIDEO: if (!GoHardware(pcc)) { bretval=FALSE; //no camera or card! fail! *pBytesReturned=(DWORD)HADSHR_ERR_DATA_CORRUPTION; } else { bretval = Local_ReadVideo(pcc, ((PHWCMD_INPUT_HEADER_TYPE)pInBuf)->hdr.readVideoInfo, (PBYTE) pOutBuf, pBytesReturned); } break; case IOCTL_HWCMD_READ_DWORD: if ((!pInBuf) || (nInBufSize < sizeof(HWCMD_INPUT_HEADER_TYPE)) || (!pOutBuf) || (nOutBufSize < ((PHWCMD_INPUT_HEADER_TYPE)pInBuf)->hdr.StreamInfo.dwNumber )) //null buffer or wrong buffer sizes bretval=FALSE; else { dwNumBytes=((PHWCMD_INPUT_HEADER_TYPE)pInBuf)->hdr.StreamInfo.dwNumber ; if (!GoHardware(pcc)) bretval=FALSE; //no camera or card! fail! else { if (((dwNumBytes%4)!=0) || (dwNumBytes == 0))//uneven number of WORD or no DATA bretval=FALSE; else { bretval=ReadStream(pcc, ((PHWCMD_INPUT_HEADER_TYPE)pInBuf)->hdr.StreamInfo.wRegister, (PDWORD)pOutBuf, dwNumBytes); *pBytesReturned= dwNumBytes; } } } if (!bretval) { *pBytesReturned = 0; //we failed to read! } break; case IOCTL_HWCMD_WRITE_DWORD: if ((!pInBuf) || (nInBufSize < sizeof(HWCMD_INPUT_HEADER_TYPE)) || (!pOutBuf) || (nOutBufSize < ((PHWCMD_INPUT_HEADER_TYPE)pInBuf)->hdr.StreamInfo.dwNumber )) //null buffer or wrong buffer sizes bretval=FALSE; else { dwNumBytes=((PHWCMD_INPUT_HEADER_TYPE)pInBuf)->hdr.StreamInfo.dwNumber ; if (!GoHardware(pcc)) bretval=FALSE; //no camera or card! fail! else { if (((dwNumBytes%4)!=0) || (dwNumBytes == 0))//uneven number of WORD or no DATA bretval=FALSE; else { bretval=WriteStream(pcc, ((PHWCMD_INPUT_HEADER_TYPE)pInBuf)->hdr.StreamInfo.wRegister, (PDWORD)pOutBuf, dwNumBytes); *pBytesReturned= dwNumBytes; } } } if (!bretval) { *pBytesReturned = 0; //we failed to write! } break; default: bretval = FALSE; break; } LeaveCriticalSection(&pcc->ioCritSect); return bretval; } //------------------------------------------------------------------------------ void VID_PowerUp(DWORD hClientContext) { PCLIENT_CONTEXT pcc = (PCLIENT_CONTEXT)hClientContext; pcc->bResetCamera=TRUE; // reinitialized next time VID_IOControl is called // send the message to the app PostMessage(HWND_BROADCAST, WM_POWERBROADCAST, 103, 103); // success if TRUE } //------------------------------------------------------------------------------ void VID_PowerDown(DWORD hClientContext) { PCLIENT_CONTEXT pcc = (PCLIENT_CONTEXT)hClientContext; pcc->bInitialized=FALSE; PowerOff(pcc); // send the message to the app PostMessage(HWND_BROADCAST, WM_POWERBROADCAST, 203, 203); // success if TRUE } ///////////////////////////////////////////////////////// // // DLL entrypoint! // ///////////////////////////////////////////////////////// BOOL WINAPI DllMain(HINSTANCE DllInstance, ULONG Reason, LPVOID Reserved) { switch(Reason) { case DLL_PROCESS_ATTACH: #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: DllMain(): dll attach.\r\n")); #endif break; case DLL_PROCESS_DETACH: #ifdef _DEBUG OutputDebugString(TEXT("MOVIEDLL: DllMain(): dll detach.\r\n")); #endif break; } return TRUE; }