diff options
Diffstat (limited to 'x-plane-plugin/plugin.c')
| -rw-r--r-- | x-plane-plugin/plugin.c | 152 |
1 files changed, 152 insertions, 0 deletions
diff --git a/x-plane-plugin/plugin.c b/x-plane-plugin/plugin.c new file mode 100644 index 00000000..62c9d6f0 --- /dev/null +++ b/x-plane-plugin/plugin.c @@ -0,0 +1,152 @@ +#include <stdlib.h> +#include <stdio.h> +#include <stdbool.h> +#include <string.h> +#include <sys/file.h> +#include <sys/mman.h> +#include <limits.h> +#include <unistd.h> + +#include <XPLMPlugin.h> +#include <XPLMDisplay.h> +#include <XPLMDataAccess.h> +#include <XPLMCamera.h> +#include <XPLMProcessing.h> + +#include "ftnoir_tracker_base/ftnoir_tracker_types.h" + +#ifndef PLUGIN_API +#define PLUGIN_API +#endif + +/* using Wine name to ease things */ +#define WINE_SHM_NAME "facetracknoir-wine-shm" +#define WINE_MTX_NAME "facetracknoir-wine-mtx" + +typedef struct PortableLockedShm { + void* mem; + int fd, size; +} PortableLockedShm; + +typedef struct WineSHM { + double data[6]; + int gameid, gameid2; + unsigned char table[8]; + bool stop; +} WineSHM; + +static PortableLockedShm* lck_posix = NULL; +static WineSHM* shm_posix = NULL; +static void *view_x, *view_y, *view_z, *view_heading, *view_pitch; +static float offset_x, offset_y, offset_z; + +static void reinit_offset() { + offset_x = XPLMGetDataf(view_x); + offset_y = XPLMGetDataf(view_y); + offset_z = XPLMGetDataf(view_z); +} + +#ifdef __GNUC__ +# define OT_UNUSED(varname) varname __attribute__((__unused__)) +#else +# define OT_UNUSED(varname) varname +#endif + +PortableLockedShm* PortableLockedShm_init(const char *shmName, const char *OT_UNUSED(mutexName), int mapSize) +{ + PortableLockedShm* self = malloc(sizeof(PortableLockedShm)); + char shm_filename[NAME_MAX]; + shm_filename[0] = '/'; + strncpy(shm_filename+1, shmName, NAME_MAX-2); + shm_filename[NAME_MAX-1] = '\0'; + /* (void) shm_unlink(shm_filename); */ + + self->fd = shm_open(shm_filename, O_RDWR | O_CREAT, 0600); + (void) ftruncate(self->fd, mapSize); + self->mem = mmap(NULL, mapSize, PROT_READ|PROT_WRITE, MAP_SHARED, self->fd, (off_t)0); + return self; +} + +void PortableLockedShm_free(PortableLockedShm* self) +{ + /*(void) shm_unlink(shm_filename);*/ + (void) munmap(self->mem, self->size); + (void) close(self->fd); + free(self); +} + +void PortableLockedShm_lock(PortableLockedShm* self) +{ + flock(self->fd, LOCK_SH); +} + +void PortableLockedShm_unlock(PortableLockedShm* self) +{ + flock(self->fd, LOCK_UN); +} + +int write_head_position( + XPLMDrawingPhase OT_UNUSED(inPhase), + int OT_UNUSED(inIsBefore), + void * OT_UNUSED(inRefcon)) +{ + if (lck_posix != NULL && shm_posix != NULL) { + PortableLockedShm_lock(lck_posix); + XPLMSetDataf(view_x, shm_posix->data[TX] * 1e-3 + offset_x); + XPLMSetDataf(view_y, shm_posix->data[TY] * 1e-3 + offset_y); + XPLMSetDataf(view_z, shm_posix->data[TZ] * 1e-3 + offset_z); + XPLMSetDataf(view_heading, shm_posix->data[Yaw] * 180 / 3.141592654); + XPLMSetDataf(view_pitch, shm_posix->data[Pitch] * 180 / 3.141592654); + PortableLockedShm_unlock(lck_posix); + } + return 1; +} + +PLUGIN_API int XPluginStart ( char * outName, char * outSignature, char * outDescription ) { + view_x = XPLMFindDataRef("sim/aircraft/view/acf_peX"); + view_y = XPLMFindDataRef("sim/aircraft/view/acf_peY"); + view_z = XPLMFindDataRef("sim/aircraft/view/acf_peZ"); + view_heading = XPLMFindDataRef("sim/graphics/view/pilots_head_psi"); + view_pitch = XPLMFindDataRef("sim/graphics/view/pilots_head_the"); + if (view_x && view_y && view_z && view_heading && view_pitch) { + lck_posix = PortableLockedShm_init(WINE_SHM_NAME, WINE_MTX_NAME, sizeof(WineSHM)); + if (lck_posix->mem == (void*)-1) { + fprintf(stderr, "opentrack failed to init SHM!\n"); + return 0; + } + shm_posix = (WineSHM*) lck_posix->mem; + memset(shm_posix, 0, sizeof(WineSHM)); + strcpy(outName, "opentrack"); + strcpy(outSignature, "opentrack - freetrack lives!"); + strcpy(outDescription, "head tracking view control"); + fprintf(stderr, "opentrack init complete\n"); + return 1; + } + return 0; +} + +PLUGIN_API void XPluginStop ( void ) { + if (lck_posix) + { + PortableLockedShm_free(lck_posix); + lck_posix = NULL; + shm_posix = NULL; + } +} + +PLUGIN_API void XPluginEnable ( void ) { + XPLMRegisterDrawCallback(write_head_position, xplm_Phase_LastScene, 1, NULL); +} + +PLUGIN_API void XPluginDisable ( void ) { + XPLMUnregisterDrawCallback(write_head_position, xplm_Phase_LastScene, 1, NULL); +} + +PLUGIN_API void XPluginReceiveMessage( + XPLMPluginID OT_UNUSED(inFromWho), + int OT_UNUSED(inMessage), + void * OT_UNUSED(inParam)) +{ + if (inMessage == XPLM_MSG_AIRPORT_LOADED) + reinit_offset(); +} |