diff options
author | Stanislaw Halik <sthalik@misaki.pl> | 2018-05-22 17:07:04 +0200 |
---|---|---|
committer | Stanislaw Halik <sthalik@misaki.pl> | 2018-05-22 17:07:04 +0200 |
commit | dec40bea45d222a1a2447ca126631bc744ba7faa (patch) | |
tree | a75719d7bb4ea069d15f98a0e30b4dc55ddf2501 /contrib | |
parent | d092b050a87b075c43645b34ad00e93b53e24fe2 (diff) |
proto/ft: revert npclient to 2.3.10
Diffstat (limited to 'contrib')
-rw-r--r-- | contrib/npclient/npclient.c | 299 |
1 files changed, 131 insertions, 168 deletions
diff --git a/contrib/npclient/npclient.c b/contrib/npclient/npclient.c index ac8757f4..03fa589a 100644 --- a/contrib/npclient/npclient.c +++ b/contrib/npclient/npclient.c @@ -3,9 +3,9 @@ #include <stdarg.h> #include <stdlib.h> #include <stdbool.h> -#include <stdint.h> #include <math.h> #include <string.h> +#include <stdio.h> #include <windows.h> @@ -14,8 +14,6 @@ #define UNUSED(var) (void)var -//#define DEBUG - typedef struct TFreeTrackData { int DataID; @@ -41,91 +39,44 @@ typedef struct TFreeTrackData float Y3; float X4; float Y4; -} volatile TFreeTrackData; +} TFreeTrackData; typedef struct FTMemMap { TFreeTrackData data; - uint32_t GameId; + __int32 GameId; unsigned char table[8]; - uint32_t GameId2; -} volatile FTMemMap; + __int32 GameId2; +} FTMemMap; + +static bool bEncryptionChecked = false; +static double r = 0, p = 0, y = 0, tx = 0, ty = 0, tz = 0; #define NP_DECLSPEC __declspec(dllexport) #define NP_EXPORT(t) t NP_DECLSPEC __stdcall #define NP_AXIS_MAX 16383 -static uint32_t volatile game_id_local; -static HANDLE hFTMemMap = 0; -static FTMemMap* pMemData = 0; - -#if defined _MSC_VER -# define force_inline __forceinline -#else -# define force_inline __attribute__((always_inline, gnu_inline)) inline -#endif - -#ifdef DEBUG -# include <stdio.h> -# define dbg_report(...) \ - do \ - { \ - if (debug_stream) \ - { \ - fprintf(debug_stream, __VA_ARGS__); \ - fprintf(debug_stream, "\n"); \ - fflush(debug_stream); \ - } \ - } while (0) +static bool FTCreateMapping(void); +static void FTDestroyMapping(void); +static __inline double clamp(double x, double xmin, double xmax); +static __inline double clamp_(double x); +#if DEBUG static FILE *debug_stream; +#define dbg_report(...) do { if (debug_stream) { fprintf(debug_stream, __VA_ARGS__); fflush(debug_stream); } } while(0); #else -# define dbg_report(...) do { (void)0; } while (0) +#define dbg_report(...) #endif -static bool FTCreateMapping(void) -{ - if (pMemData) - return true; - - dbg_report("FTCreateMapping request (pMemData == NULL)"); - - HANDLE hFTMutex = CreateMutexA(NULL, FALSE, FREETRACK_MUTEX); - CloseHandle(hFTMutex); - - hFTMemMap = CreateFileMappingA(INVALID_HANDLE_VALUE, 0, PAGE_READWRITE, 0, sizeof(FTMemMap), FT_MM_DATA); - pMemData = (FTMemMap *) MapViewOfFile(hFTMemMap, FILE_MAP_WRITE, 0, 0, sizeof(FTMemMap)); - return pMemData != NULL; -} - -static void FTDestroyMapping(void) -{ - if (pMemData != NULL) - { - InterlockedExchange((LONG volatile*) &pMemData->data.DataID, -1); - UnmapViewOfFile((void*)pMemData); - } - - CloseHandle(hFTMemMap); - pMemData = 0; - hFTMemMap = 0; -} - -static force_inline double clamp(double x, double xmin, double xmax) -{ - if (x > xmax) - return xmax; - - if (x < xmin) - return xmin; - - return x; -} +typedef enum npclient_status_ { + NPCLIENT_STATUS_OK, + NPCLIENT_STATUS_DISABLED +} npclient_status; -static force_inline double clamp_(double x) -{ - return clamp(x, -NP_AXIS_MAX, NP_AXIS_MAX); -} +static HANDLE hFTMemMap = 0; +static FTMemMap volatile * pMemData = 0; +static bool bEncryption = false; +static unsigned char table[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; typedef struct tir_data { @@ -135,13 +86,13 @@ typedef struct tir_data float roll, pitch, yaw; float tx, ty, tz; float padding[9]; -} tir_data; +} tir_data_t; typedef struct tir_signature { char DllSignature[200]; char AppSignature[200]; -} tir_signature; +} tir_signature_t; BOOL DllMain(HINSTANCE hinstDLL, DWORD fdwReason, LPVOID lpvReserved) { @@ -150,17 +101,16 @@ BOOL DllMain(HINSTANCE hinstDLL, DWORD fdwReason, LPVOID lpvReserved) switch (fdwReason) { case DLL_PROCESS_ATTACH: -#ifdef DEBUG +#if DEBUG debug_stream = fopen("c:\\NPClient.log", "a"); #endif - #ifdef _WIN64 - dbg_report("\n= WIN64 ========================================================================================="); + dbg_report("\n= WIN64 =========================================================================================\n"); #else - dbg_report("\n= WIN32 ========================================================================================="); + dbg_report("\n= WIN32 =========================================================================================\n"); #endif - dbg_report("DllMain: (%p, %ld, %p)", (void*) hinstDLL, (long) fdwReason, lpvReserved); - dbg_report("DllMain: Attach request"); + dbg_report("DllMain: (%p, %ld, %p)\n", (void*) hinstDLL, (long) fdwReason, lpvReserved); + dbg_report("DllMain: Attach request\n"); DisableThreadLibraryCalls(hinstDLL); #if 0 timeBeginPeriod(1); @@ -168,13 +118,12 @@ BOOL DllMain(HINSTANCE hinstDLL, DWORD fdwReason, LPVOID lpvReserved) break; case DLL_PROCESS_DETACH: - dbg_report("DllMain: Detach"); + dbg_report("DllMain: Detach\n"); dbg_report("DllMain: (%p, %ld, %p)\n", (void*) hinstDLL, (long) fdwReason, lpvReserved); - dbg_report("=========================================================================================="); + dbg_report("==========================================================================================\n"); #if 0 timeEndPeriod(1); #endif - FTDestroyMapping(); break; } @@ -186,7 +135,7 @@ BOOL DllMain(HINSTANCE hinstDLL, DWORD fdwReason, LPVOID lpvReserved) NP_EXPORT(int) NPPriv_ClientNotify(void) { - dbg_report("stub"); + dbg_report("stub\n"); /* @stub in .spec */ return 0; } @@ -196,7 +145,7 @@ NP_EXPORT(int) NPPriv_ClientNotify(void) NP_EXPORT(int) NPPriv_GetLastError(void) { - dbg_report("stub"); + dbg_report("stub\n"); /* @stub in .spec */ return 0; } @@ -206,7 +155,7 @@ NP_EXPORT(int) NPPriv_GetLastError(void) NP_EXPORT(int) NPPriv_SetData(void) { - dbg_report("stub"); + dbg_report("stub\n"); /* @stub in .spec */ return 0; } @@ -216,7 +165,7 @@ NP_EXPORT(int) NPPriv_SetData(void) NP_EXPORT(int) NPPriv_SetLastError(void) { - dbg_report("stub"); + dbg_report("stub\n"); /* @stub in .spec */ return 0; } @@ -226,7 +175,7 @@ NP_EXPORT(int) NPPriv_SetLastError(void) NP_EXPORT(int) NPPriv_SetParameter(void) { - dbg_report("stub"); + dbg_report("stub\n"); /* @stub in .spec */ return 0; } @@ -236,7 +185,7 @@ NP_EXPORT(int) NPPriv_SetParameter(void) NP_EXPORT(int) NPPriv_SetSignature(void) { - dbg_report("stub"); + dbg_report("stub\n"); /* @stub in .spec */ return 0; } @@ -246,7 +195,7 @@ NP_EXPORT(int) NPPriv_SetSignature(void) NP_EXPORT(int) NPPriv_SetVersion(void) { - dbg_report("stub"); + dbg_report("stub\n"); /* @stub in .spec */ return 0; } @@ -313,7 +262,7 @@ static unsigned cksum(unsigned char buf[], unsigned size) return (unsigned)c; } -static inline void enhance(unsigned char buf[], unsigned size, unsigned char table[], unsigned table_size) +static __inline void enhance(unsigned char buf[], unsigned size, unsigned char table[], unsigned table_size) { unsigned table_ptr = 0; unsigned char var = 0x88; @@ -339,30 +288,24 @@ static inline void enhance(unsigned char buf[], unsigned size, unsigned char tab * NP_GetData (NPCLIENT.8) */ -typedef enum npclient_status_ { - NPCLIENT_STATUS_OK, - NPCLIENT_STATUS_DISABLED -} npclient_status; - -NP_EXPORT(int) NP_GetData(tir_data* data) +NP_EXPORT(int) NP_GetData(tir_data_t * data) { - static double r = 0, p = 0, y = 0, tx = 0, ty = 0, tz = 0; - static unsigned frameno = 0; - static unsigned char table[8] = {0}; - static bool bEncryption = false; - static bool bEncryptionChecked = false; - int i, data_id = -1; - + static int frameno = 0; + int i; +#if DEBUG + int recv = 0; +#endif if (!FTCreateMapping()) { - dbg_report("Can't open mapping"); - return NPCLIENT_STATUS_DISABLED; + dbg_report("Can't open mapping\n"); + return 0; } - if (game_id_local > 0 && - pMemData->GameId == game_id_local && - pMemData->GameId == pMemData->GameId2) + if (pMemData) { +#if DEBUG + recv = 1; +#endif y = pMemData->data.Yaw * NP_AXIS_MAX / M_PI; p = pMemData->data.Pitch * NP_AXIS_MAX / M_PI; r = pMemData->data.Roll * NP_AXIS_MAX / M_PI; @@ -371,9 +314,9 @@ NP_EXPORT(int) NP_GetData(tir_data* data) ty = pMemData->data.Y * NP_AXIS_MAX / 500.; tz = pMemData->data.Z * NP_AXIS_MAX / 500.; - if (!bEncryptionChecked) + if (pMemData->GameId == pMemData->GameId2 && !bEncryptionChecked) { - dbg_report("NP_GetData: game = %d", pMemData->GameId); + dbg_report("NP_GetData: game = %d\n", pMemData->GameId); bEncryptionChecked = true; memcpy(table, (void*)pMemData->table, 8); for (i = 0; i < 8; i++) @@ -382,29 +325,17 @@ NP_EXPORT(int) NP_GetData(tir_data* data) bEncryption = true; break; } - dbg_report("NP_GetData: Table = %02d %02d %02d %02d %02d %02d %02d %02d", table[0],table[1],table[2],table[3],table[4],table[5], table[6], table[7]); + dbg_report("NP_GetData: Table = %02d %02d %02d %02d %02d %02d %02d %02d\n", table[0],table[1],table[2],table[3],table[4],table[5], table[6], table[7]); } - - data_id = InterlockedCompareExchange((LONG volatile*) &pMemData->data.DataID, -1, -1); } - data->frame = ++frameno; + frameno++; + data->frame = frameno; - bool running = false; + bool running = y != 0 || p != 0 || r != 0 || + tx != 0 || ty != 0 || tz != 0; - if (data_id == 0) - { - running = true; - y = 0, r = 0, p = 0, tx = 0, ty = 0, tz = 0; - (void)InterlockedCompareExchange((LONG volatile*) &pMemData->data.DataID, -1, 0); - } - else if (data_id > 0) - { - running = true; - (void)InterlockedCompareExchange((LONG volatile*) &pMemData->data.DataID, data_id - 1, data_id); - } - - data->status = NPCLIENT_STATUS_OK; + data->status = running ? NPCLIENT_STATUS_OK : NPCLIENT_STATUS_DISABLED; data->cksum = 0; data->roll = clamp_(r); @@ -415,18 +346,17 @@ NP_EXPORT(int) NP_GetData(tir_data* data) data->ty = clamp_(ty); data->tz = clamp_(tz); - for (i = 0; i < 9; ++i) - data->padding[i] = 0; + for(i = 0; i < 9; ++i) + data->padding[i] = 0.0; -#ifdef DEBUG - dbg_report("GetData: rotation: %f %f %f", data->yaw, data->pitch, data->roll); - dbg_report("GetData: status:%d dataid:%d enc:%d id1:%d id2:%d\n", (int) running, data_id, (int)bEncryption, (int)pMemData->GameId, (int)pMemData->GameId2); +#if DEBUG + dbg_report("GetData: rotation: %d %f %f %f\n", recv, data->yaw, data->pitch, data->roll); #endif - data->cksum = cksum((unsigned char*)data, sizeof(*data)); + data->cksum = cksum((unsigned char*)data, sizeof(tir_data_t)); if (bEncryption) - enhance((unsigned char*)data, sizeof(*data), table, sizeof(table)); + enhance((unsigned char*)data, sizeof(tir_data_t), table, sizeof(table)); return running ? NPCLIENT_STATUS_OK : NPCLIENT_STATUS_DISABLED; } @@ -437,8 +367,8 @@ NP_EXPORT(int) NP_GetData(tir_data* data) NP_EXPORT(int) NP_GetParameter(int arg0, int arg1) { UNUSED(arg0); UNUSED(arg1); - dbg_report("GetParameter request: %d %d", arg0, arg1); - return 0; + dbg_report("GetParameter request: %d %d\n", arg0, arg1); + return (int) 0; } /****************************************************************** @@ -447,7 +377,7 @@ NP_EXPORT(int) NP_GetParameter(int arg0, int arg1) * */ -static unsigned char volatile const part2_2[] = { +static volatile unsigned char part2_2[200] = { 0xe3, 0xe5, 0x8e, 0xe8, 0x06, 0xd4, 0xab, 0xcf, 0xfa, 0x51, 0xa6, 0x84, 0x69, 0x52, 0x21, 0xde, 0x6b, 0x71, 0xe6, 0xac, 0xaa, @@ -462,10 +392,11 @@ static unsigned char volatile const part2_2[] = { 0xe4, 0xc0, 0xf1, 0x7f, 0x87, 0xd0, 0x70, 0xa4, 0x04, 0x07, 0x05, 0x69, 0x2a, 0x16, 0x15, 0x55, 0x85, 0xa6, 0x30, 0xc8, 0xb6, + 0x00 }; -static unsigned char volatile const part1_2[] = { +static volatile unsigned char part1_2[200] = { 0x6d, 0x0b, 0xab, 0x56, 0x74, 0xe6, 0x1c, 0xff, 0x24, 0xe8, 0x34, 0x8f, 0x00, 0x63, 0xed, 0x47, 0x5d, 0x9b, 0xe1, 0xe0, 0x1d, @@ -481,10 +412,10 @@ static unsigned char volatile const part1_2[] = { 0x5d, 0x1a, 0xb4, 0x84, 0x9c, 0x29, 0xf0, 0xe6, 0x69, 0x73, 0x66, 0x0e, 0x4b, 0x3c, 0x7d, 0x99, 0x8b, 0x4e, 0x7d, 0xaf, 0x86, - 0x92 + 0x92, 0xff }; -static unsigned char volatile const part2_1[] = { +static volatile unsigned char part2_1[200] = { 0x8b, 0x84, 0xfc, 0x8c, 0x71, 0xb5, 0xd9, 0xaa, 0xda, 0x32, 0xc7, 0xe9, 0x0c, 0x20, 0x40, 0xd4, 0x4b, 0x02, 0x89, 0xca, 0xde, @@ -499,9 +430,10 @@ static unsigned char volatile const part2_1[] = { 0x81, 0x83, 0x9e, 0x11, 0xf3, 0xa2, 0x1f, 0xc8, 0x24, 0x53, 0x60, 0x0a, 0x42, 0x78, 0x7a, 0x39, 0xea, 0xc1, 0x59, 0xad, 0xc5, + 0x00 }; -static unsigned char volatile const part1_1[] = { +static volatile unsigned char part1_1[200] = { 0x1d, 0x79, 0xce, 0x35, 0x1d, 0x95, 0x79, 0xdf, 0x4c, 0x8d, 0x55, 0xeb, 0x20, 0x17, 0x9f, 0x26, 0x3e, 0xf0, 0x88, 0x8e, 0x7a, @@ -517,30 +449,24 @@ static unsigned char volatile const part1_1[] = { 0x24, 0x7f, 0xf7, 0xeb, 0xf2, 0x5d, 0x82, 0x89, 0x05, 0x53, 0x32, 0x6b, 0x28, 0x54, 0x13, 0xf6, 0xe7, 0x21, 0x1a, 0xc6, 0xe3, - 0xe1 + 0xe1, 0xff }; -NP_EXPORT(int) NP_GetSignature(tir_signature* sig) +NP_EXPORT(int) NP_GetSignature(tir_signature_t * sig) { - unsigned i; - dbg_report("GetSignature request"); + int i; + dbg_report("GetSignature request\n"); - for (i = 0; i < sizeof(part1_1); i++) + for (i = 0; i < 200; i++) sig->DllSignature[i] = part1_2[i] ^ part1_1[i]; - for (; i < 200; i++) - sig->DllSignature[i] = '\0'; - - for (i = 0; i < sizeof(part2_1); i++) + for (i = 0; i < 200; i++) sig->AppSignature[i] = part2_1[i] ^ part2_2[i]; - for (; i < 200; i++) - sig->AppSignature[i] = '\0'; - return 0; } -NP_EXPORT(int) NP_QueryVersion(unsigned short* version) +NP_EXPORT(int) NP_QueryVersion(unsigned short * version) { - dbg_report("QueryVersion request"); + dbg_report("QueryVersion request\n"); *version=0x0500; return 0; } @@ -561,10 +487,7 @@ NP_EXPORT(int) NP_ReCenter(void) NP_EXPORT(int) NP_RegisterProgramProfileID(unsigned short id) { if (FTCreateMapping()) - { pMemData->GameId = id; - game_id_local = id; - } dbg_report("RegisterProgramProfileID request: %d\n", id); return 0; } @@ -576,7 +499,7 @@ NP_EXPORT(int) NP_RegisterWindowHandle(HWND hwnd) { UNUSED(hwnd); dbg_report("RegisterWindowHandle request: %p\n", (void*) hwnd); - return 0; + return (int) 0; } /****************************************************************** * NP_RequestData (NPCLIENT.15) @@ -586,7 +509,7 @@ NP_EXPORT(int) NP_RequestData(unsigned short req) { UNUSED(req); dbg_report("RequestData request: %d\n", req); - return 0; + return (int) 0; } /****************************************************************** * NP_SetParameter (NPCLIENT.16) @@ -596,7 +519,7 @@ NP_EXPORT(int) NP_SetParameter(int arg0, int arg1) { UNUSED(arg0); UNUSED(arg1); dbg_report("SetParameter request: %d %d\n", arg0, arg1); - return 0; + return (int) 0; } /****************************************************************** * NP_StartCursor (NPCLIENT.17) @@ -605,7 +528,7 @@ NP_EXPORT(int) NP_SetParameter(int arg0, int arg1) NP_EXPORT(int) NP_StartCursor(void) { dbg_report("StartCursor request\n"); - return 0; + return (int) 0; } /****************************************************************** * NP_StartDataTransmission (NPCLIENT.18) @@ -615,7 +538,7 @@ NP_EXPORT(int) NP_StartDataTransmission(void) { dbg_report("StartDataTransmission request.\n"); - return 0; + return (int) 0; } /****************************************************************** * NP_StopCursor (NPCLIENT.19) @@ -624,7 +547,7 @@ NP_EXPORT(int) NP_StartDataTransmission(void) NP_EXPORT(int) NP_StopCursor(void) { dbg_report("StopCursor request\n"); - return 0; + return (int) 0; } /****************************************************************** * NP_StopDataTransmission (NPCLIENT.20) @@ -632,7 +555,7 @@ NP_EXPORT(int) NP_StopCursor(void) NP_EXPORT(int) NP_StopDataTransmission(void) { - return 0; + return (int) 0; } /****************************************************************** * NP_UnregisterWindowHandle (NPCLIENT.21) @@ -641,6 +564,46 @@ NP_EXPORT(int) NP_StopDataTransmission(void) NP_EXPORT(int) NP_UnregisterWindowHandle(void) { dbg_report("UnregisterWindowHandle request\n"); - return 0; + return (int) 0; +} + +static bool FTCreateMapping(void) +{ + if (pMemData) + return true; + + dbg_report("FTCreateMapping request (pMemData == NULL).\n"); + + HANDLE hFTMutex = CreateMutexA(NULL, FALSE, FREETRACK_MUTEX); + CloseHandle(hFTMutex); + + hFTMemMap = CreateFileMappingA(INVALID_HANDLE_VALUE, 0, PAGE_READWRITE, 0, sizeof(FTMemMap), (LPCSTR) FT_MM_DATA); + pMemData = (FTMemMap *) MapViewOfFile(hFTMemMap, FILE_MAP_WRITE, 0, 0, sizeof(FTMemMap)); + return pMemData != NULL; } +static void FTDestroyMapping(void) +{ + if (pMemData != NULL) + UnmapViewOfFile((void*)pMemData); + + CloseHandle(hFTMemMap); + pMemData = 0; + hFTMemMap = 0; +} + +static __inline double clamp(double x, double xmin, double xmax) +{ + if (x > xmax) + return xmax; + + if (x < xmin) + return xmin; + + return x; +} + +static __inline double clamp_(double x) +{ + return clamp(x, -NP_AXIS_MAX, NP_AXIS_MAX); +} |