?? gpsvirtualdriver.cpp
字號(hào):
// GpsVirtualDriver.cpp : Defines the entry point for the DLL application.
//
#include "stdafx.h"
//#define LOG_CALLS
char * atoh = "0123456789ABCDEF";
// " 0 1 2 3 4 5 6 7 8 9 : ; < = > ? @ A B C D E F"
BYTE htoa1[] = {0x00,0x10,0x20,0x30,0x40,0x50,0x60,0x70,0x80,0x90,0,0,0,0,0,0,0,0xA0,0xB0,0xC0,0xD0,0xE0,0xF0};
BYTE htoa2[] = {0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0,0,0,0,0,0,0,0x0A,0x0B,0x0C,0x0D,0x0E,0x0F};
void Convert( LPVOID pBuffer, DWORD Count )
{
char* pCh = (char*)pBuffer;
char ch, crc1, crc2; DWORD nCRC; BYTE state = 10;
for (DWORD i=0;i<Count; i++)
{
ch = pCh[i];
if (ch == '$')
state = 11;
else
{
switch ( state )
{
// case 10: state = ch == '$'? 11:10; break;
case 11: state = ch == 'G'? 12:10; break;
case 12: state = ch == 'P'? 13:10; break;
case 13: state = ch == 'R'? 14:10; break;
case 14: state = ch == 'M'? 15:10; break;
case 15: state = ch == 'C'? 16:10; break;
case 16: state = ch == ','? 20:10; break;
case 20: if (ch == 'A') state = 21; break;
case 21: state = ch == '*'? 22:20; break;
case 22:
crc1 = ch; state = 23; break;
case 23:
{
crc2 = ch;
// get the crc
nCRC = htoa1[crc1 - '0'] + htoa2[crc2 - '0'];
// remove the chars we are deleting
nCRC -= 'A';
nCRC -= ',';
// ... ,,A*72\n
// ^ current pos
// ^ current pos
pCh[i-4]='*';
pCh[i-3]=atoh[(nCRC & 0xF0) >> 4];
pCh[i-2]=atoh[ nCRC & 0x0F ];
pCh[i-1]=13;
pCh[i-0]=10;
}
break;
}
}
}
}
#ifdef LOG_CALLS
void Log(LPCTSTR szStr, bool bLF = true)
{
HANDLE hFile = CreateFile ( _T("\\log.txt"), GENERIC_WRITE, FILE_SHARE_READ, NULL, OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL | FILE_FLAG_WRITE_THROUGH, NULL);
SetFilePointer( hFile, 0, 0, FILE_END );
DWORD dwLen;
BOOL bOK = WriteFile( hFile, szStr, _tcslen(szStr)*sizeof(TCHAR), &dwLen, NULL );
WriteFile( hFile, _T("\n"), _tcslen(_T("\n")), &dwLen, NULL );
CloseHandle( hFile );
OutputDebugString( szStr );
/*
FILE *f = fopen("\\DemoDriverLog.txt", "a");
fprintf(f, "%u", GetTickCount());
fprintf(f, "%s", szStr);
if (bLF)
fprintf(f, "\n");
fflush(f);
fclose(f);
*/
}
#endif
GPSVIRTUALDRIVERDLL_API DWORD COM_Init(LPCTSTR pContext, LPCVOID lpvBusContext);
GPSVIRTUALDRIVERDLL_API BOOL COM_Deinit( DWORD hDeviceContext );
GPSVIRTUALDRIVERDLL_API DWORD COM_Open( DWORD hDeviceContext, DWORD AccessCode, DWORD ShareMode );
GPSVIRTUALDRIVERDLL_API BOOL COM_Close( DWORD hOpenContext );
GPSVIRTUALDRIVERDLL_API BOOL COM_IOControl( DWORD hOpenContext, DWORD dwCode, PBYTE pBufIn, DWORD dwLenIn, PBYTE pBufOut, DWORD dwLenOut, PDWORD pdwActualOut );
GPSVIRTUALDRIVERDLL_API void COM_PowerUp( DWORD hDeviceContext );
GPSVIRTUALDRIVERDLL_API void COM_PowerDown( DWORD hDeviceContext );
GPSVIRTUALDRIVERDLL_API DWORD COM_Read( DWORD hOpenContext, LPVOID pBuffer, DWORD Count );
GPSVIRTUALDRIVERDLL_API DWORD COM_Write( DWORD hOpenContext, LPCVOID pBuffer, DWORD Count );
GPSVIRTUALDRIVERDLL_API DWORD COM_Seek( DWORD hOpenContext, long Amount, WORD Type );
#define DEVICE_CONTEXT 0x1450
#define OPEN_CONTEXT 0x1451
HANDLE hComm = INVALID_HANDLE_VALUE;
DWORD dwManagePort = 1;
BOOL APIENTRY DllMain( HANDLE hModule,
DWORD ul_reason_for_call,
LPVOID lpReserved
)
{
switch ( ul_reason_for_call )
{
case DLL_PROCESS_ATTACH:
break;
case DLL_PROCESS_DETACH:
break;
case DLL_THREAD_ATTACH:
break;
case DLL_THREAD_DETACH:
break;
}
return TRUE;
}
GPSVIRTUALDRIVERDLL_API DWORD COM_Init( LPCTSTR pContext, LPCVOID lpvBusContext)
{
#ifdef LOG_CALLS
Log(_T("Init\n"));
#endif
DWORD dwPort = 0;
HKEY hKey;
if (RegOpenKeyEx(HKEY_LOCAL_MACHINE, pContext, 0, 0, &hKey) == ERROR_SUCCESS)
{
TCHAR szDriverKey[255];
DWORD dwSize = 255;
DWORD dwType;
if (RegQueryValueEx(hKey, L"Key", 0, &dwType, (BYTE *)szDriverKey, &dwSize) == ERROR_SUCCESS)
{
RegCloseKey(hKey);
if (RegOpenKeyEx(HKEY_LOCAL_MACHINE, szDriverKey, 0, 0, &hKey) == ERROR_SUCCESS)
{
dwSize=4;
if (RegQueryValueEx(hKey, L"ManagePort", 0, &dwType, (BYTE *)&dwPort, &dwSize) != ERROR_SUCCESS)
dwPort = 0;
RegCloseKey(hKey);
}
}
}
if (dwPort != 0)
dwManagePort = dwPort;
return DEVICE_CONTEXT;
}
GPSVIRTUALDRIVERDLL_API BOOL COM_Deinit( DWORD hDeviceContext )
{
if (hDeviceContext != DEVICE_CONTEXT)
{
#ifdef LOG_CALLS
Log(_T("False Deinst\n"));
#endif
return FALSE;
}
#ifdef LOG_CALLS
Log(_T("DeInit\n"));
#endif
return TRUE;
}
GPSVIRTUALDRIVERDLL_API DWORD COM_Open( DWORD hDeviceContext, DWORD AccessCode, DWORD ShareMode )
{
if (hDeviceContext != DEVICE_CONTEXT)
{
#ifdef LOG_CALLS
Log(_T("False Open\n"));
#endif
return 0;
}
TCHAR szPort[255];
swprintf(szPort, L"COM%u:", dwManagePort);
hComm = CreateFile(
szPort,
AccessCode,
ShareMode,
NULL,
OPEN_EXISTING,
0,
NULL);
#ifdef LOG_CALLS
TCHAR buf[255];
_stprintf(buf, _T("Open port %s for access %u and share %u %s\n"), szPort, AccessCode, ShareMode, hComm ? _T("OK") : _T("Failed"));
Log(buf);
#endif
if (hComm == INVALID_HANDLE_VALUE)
return 0;
else
return OPEN_CONTEXT;
}
GPSVIRTUALDRIVERDLL_API BOOL COM_Close( DWORD hOpenContext )
{
if (hOpenContext != OPEN_CONTEXT)
{
#ifdef LOG_CALLS
Log(_T("False Close\n"));
#endif
return 0;
}
#ifdef LOG_CALLS
Log(_T("Close\n"));
#endif
BOOL bRet = CloseHandle(hComm);
return bRet;
}
GPSVIRTUALDRIVERDLL_API BOOL COM_IOControl( DWORD hOpenContext, DWORD dwCode, PBYTE pBufIn, DWORD dwLenIn, PBYTE pBufOut, DWORD dwLenOut, PDWORD pdwActualOut )
{
if (hOpenContext != OPEN_CONTEXT)
{
#ifdef LOG_CALLS
Log(_T("False IOControl\n"));
#endif
return 0;
}
#ifdef LOG_CALLS
TCHAR buf[255];
_stprintf(buf, _T("Control code=%u, inlen=%u\n"), dwCode, dwLenIn);
Log(buf);
#endif
BOOL bRet=DeviceIoControl(
hComm,
dwCode,
pBufIn,
dwLenIn,
pBufOut,
dwLenOut,
pdwActualOut,
NULL);
#ifdef LOG_CALLS
_stprintf(buf, _T("IOControl return bRet=%d, outlen=%u\n"), bRet, *pdwActualOut);
Log(buf);
#endif
return bRet;
}
GPSVIRTUALDRIVERDLL_API void COM_PowerUp( DWORD hDeviceContext )
{
}
GPSVIRTUALDRIVERDLL_API void COM_PowerDown( DWORD hDeviceContext )
{
}
GPSVIRTUALDRIVERDLL_API DWORD COM_Read( DWORD hOpenContext, LPVOID pBuffer, DWORD Count )
{
if (hOpenContext != OPEN_CONTEXT)
{
#ifdef LOG_CALLS
Log(_T("False Read\n"));
#endif
return 0;
}
DWORD dwBytes = 0;
ReadFile(hComm, pBuffer, Count, &dwBytes, NULL);
Convert( pBuffer, dwBytes );
#ifdef LOG_CALLS
TCHAR buf[100];
_stprintf( buf, _T("Read max=%u, read count: %u\n"), Count, dwBytes );
Log(buf);
#endif
return dwBytes;
}
GPSVIRTUALDRIVERDLL_API DWORD COM_Write( DWORD hOpenContext, LPCVOID pBuffer, DWORD Count )
{
if (hOpenContext != OPEN_CONTEXT)
{
#ifdef LOG_CALLS
Log(_T("False Write\n"));
#endif
return 0;
}
#ifdef LOG_CALLS
TCHAR buf[255];
_stprintf(buf, _T("Write bytes=%u\n"), Count);
Log(buf);
#endif
DWORD dwBytes = 0;
WriteFile(hComm, pBuffer, Count, &dwBytes, NULL);
return dwBytes;
}
GPSVIRTUALDRIVERDLL_API DWORD COM_Seek( DWORD hOpenContext, long Amount, WORD Type )
{
#ifdef LOG_CALLS
TCHAR buf[255];
_stprintf(buf, _T("Seek Amount=%u, Type=%u\n"), Amount, Type);
Log(buf);
#endif
return 0;
}
?? 快捷鍵說(shuō)明
復(fù)制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號(hào)
Ctrl + =
減小字號(hào)
Ctrl + -