summaryrefslogtreecommitdiffhomepage
path: root/x-plane-plugin/plugin.c
diff options
context:
space:
mode:
authorStanislaw Halik <sthalik@misaki.pl>2013-04-02 18:41:01 +0200
committerStanislaw Halik <sthalik@misaki.pl>2013-04-02 18:41:01 +0200
commit8303597a865400a363ae574ccde819302495f498 (patch)
treec83b383b3ec818f610cc6137f2b72ee7b4173b09 /x-plane-plugin/plugin.c
parent8adf6b1650af6027f28db12ca2b4de92a3fac11d (diff)
Just put everything new in. Conflict resolution will be later
Diffstat (limited to 'x-plane-plugin/plugin.c')
-rw-r--r--x-plane-plugin/plugin.c185
1 files changed, 185 insertions, 0 deletions
diff --git a/x-plane-plugin/plugin.c b/x-plane-plugin/plugin.c
new file mode 100644
index 00000000..fc1a5186
--- /dev/null
+++ b/x-plane-plugin/plugin.c
@@ -0,0 +1,185 @@
+#include <stdlib.h>
+#include <stdio.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>
+
+// 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 {
+ float rx, ry, rz, tx, ty, tz;
+ char 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;
+
+PortableLockedShm* PortableLockedShm_init(const char *shmName, const char *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';
+ sprintf(shm_filename + strlen(shm_filename), "%ld\n", (long) getuid());
+ //(void) shm_unlink(shm_filename);
+
+ self->fd = shm_open(shm_filename, O_RDWR | O_CREAT, 0600);
+ if (ftruncate(self->fd, mapSize) == 0)
+ self->mem = mmap(NULL, mapSize, PROT_READ|PROT_WRITE, MAP_SHARED, self->fd, (off_t)0);
+ else
+ self->mem = (void*) -1;
+ 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);
+}
+
+static void reinit_offset() {
+ offset_x = XPLMGetDataf(view_x);
+ offset_y = XPLMGetDataf(view_y);
+ offset_z = XPLMGetDataf(view_z);
+}
+
+int write_head_position(
+ XPLMDrawingPhase inPhase,
+ int inIsBefore,
+ void * inRefcon)
+{
+ if (lck_posix != NULL && shm_posix != NULL) {
+ PortableLockedShm_lock(lck_posix);
+ XPLMSetDataf(view_x, shm_posix->tx * 1e-2 + offset_x);
+ XPLMSetDataf(view_y, shm_posix->ty * 1e-2 + offset_y);
+ XPLMSetDataf(view_z, shm_posix->tz * 1e-2 + offset_z);
+ XPLMSetDataf(view_heading, shm_posix->rx * 57.295781);
+ XPLMSetDataf(view_pitch, shm_posix->ry * 57.295781);
+ 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, "FTNOIR failed to init SHM #1!\n");
+ return 0;
+ }
+ if (lck_posix->mem == NULL) {
+ fprintf(stderr, "FTNOIR failed to init SHM #2!\n");
+ return 0;
+ }
+ shm_posix = (WineSHM*) lck_posix->mem;
+ memset(shm_posix, 0, sizeof(WineSHM));
+ strcpy(outName, "FaceTrackNoIR");
+ strcpy(outSignature, "FaceTrackNoIR - FreeTrack lives!");
+ strcpy(outDescription, "Face tracking view control");
+ fprintf(stderr, "FTNOIR init complete\n");
+ return 1;
+ }
+ return 0;
+}
+
+#if 0
+static int camera_callback(XPLMCameraPosition_t* outCameraPosition, int inIsLosingControl, void* inRefCon) {
+ if (!inIsLosingControl && XPLMGetCycleNumber() > 0) {
+ //XPLMReadCameraPosition(outCameraPosition);
+ PortableLockedShm_lock(lck_posix);
+ outCameraPosition->heading = shm_posix->rx * 57.295781;
+ outCameraPosition->pitch = shm_posix->ry * 57.295781;
+ outCameraPosition->roll = shm_posix->rz * 57.295781;
+ outCameraPosition->x = XPLMGetDataf(view_x);
+ outCameraPosition->y = XPLMGetDataf(view_y);
+ outCameraPosition->z = XPLMGetDataf(view_z);
+ PortableLockedShm_unlock(lck_posix);
+ return 1;
+ }
+ return 0;
+}
+static float flight_loop (
+ float inElapsedSinceLastCall,
+ float inElapsedTimeSinceLastFlightLoop,
+ int inCounter,
+ void * inRefcon)
+{
+ XPLMControlCamera(xplm_ControlCameraForever, camera_callback, NULL);
+ // don't want it called anymore
+ return 0;
+}
+#endif
+
+PLUGIN_API void XPluginStop ( void ) {
+#if 0
+ // crashes due to race
+ if (lck_posix)
+ PortableLockedShm_free(lck_posix);
+ lck_posix = NULL;
+ shm_posix = NULL;
+#endif
+}
+
+PLUGIN_API void XPluginEnable ( void ) {
+ reinit_offset();
+ XPLMRegisterDrawCallback(write_head_position, xplm_Phase_LastScene, 1, NULL);
+#if 0
+ XPLMRegisterFlightLoopCallback(flight_loop, -1, NULL);
+#endif
+}
+
+PLUGIN_API void XPluginDisable ( void ) {
+ XPLMUnregisterDrawCallback(write_head_position, xplm_Phase_LastScene, 1, NULL);
+ XPLMSetDataf(view_x, offset_x);
+ XPLMSetDataf(view_y, offset_y);
+ XPLMSetDataf(view_z, offset_z);
+#if 0
+ XPLMUnregisterFlightLoopCallback(flight_loop, NULL);
+ if (XPLMIsCameraBeingControlled(NULL))
+ XPLMDontControlCamera();
+#endif
+}
+
+PLUGIN_API void XPluginReceiveMessage(
+ XPLMPluginID inFromWho,
+ int inMessage,
+ void * inParam)
+{
+ if (inMessage == XPLM_MSG_AIRPORT_LOADED)
+ reinit_offset();
+}