Added waypoint support to the plugin.

- The plugin now supports drawing a series of waypoints in the world.
 - The plugin supports add, remove, and clear operations
  - Add and remove take a list of waypoints
  - Clear removes all waypoints

xpcPlugin/XPCPlugin.cpp

@@ -216,6 +216,8 @@ PLUGIN_API int XPluginEnable(void)
 		sprintf(logmsg,"[EXEC] Debug Enabled (Verbosity: %i)",debugSwitch);
 		updateLog(logmsg,strlen(logmsg));
 	}
+
+	XPCSetMessage(20, 700, "TEST");
 	
 	return 1;
 }

xpcPlugin/xpcDrawing.cpp

@@ -1,19 +1,93 @@
 #include "xpcDrawing.h"
 #include "XPLMDisplay.h"
 #include "XPLMGraphics.h"
-#include <stdlib.h>
+#include "XPLMDataAccess.h"
 #include <string.h>
+#include <stdio.h>
+#include <math.h>
+//OpenGL includes
+#if IBM
+#include <windows.h>
+#endif
+#if __GNUC__
+#include <OpenGL/gl.h>
+#else
+#include <GL/gl.h>
+#endif
+
+//Internal Structures
+typedef struct
+{
+	double x;
+	double y;
+	double z;
+} LocalPoint;
 
 //Internal Memory
+static const size_t MSG_MAX = 1024;
+static const size_t MSG_LINE_MAX = MSG_MAX / 16;
 static bool msgEnabled = false;
 static int msgX = -1;
 static int msgY = -1;
-static char msgVal[256] = { 0 };
+static char msgVal[MSG_MAX] = { 0 };
 static size_t newLineCount = 0;
-static size_t newLines[64] = { 0 };
+static size_t newLines[MSG_LINE_MAX] = { 0 };
 static float rgb[3] = { 0.25F, 1.0F, 0.25F };
 
+static const size_t WAYPOINT_MAX = 128;
+static bool routeEnabled = false;
+static size_t numWaypoints = 0;
+static Waypoint waypoints[WAYPOINT_MAX];
+static LocalPoint localPoints[WAYPOINT_MAX];
+
+XPLMDataRef planeXref;
+XPLMDataRef	planeYref;
+XPLMDataRef	planeZref;
+
 //Internal Functions
+int cmp(const void * a, const void * b)
+{
+	return (*(size_t*)a - *(size_t*)b);
+}
+
+static void gl_drawCube(float x, float y, float z, float d)
+{
+	//tan(0.25) degrees. Should scale all markers to appear about the same size
+	const float TAN = 0.00436335082070156648652885284203;
+	float h = d * TAN;
+
+	glBegin(GL_QUAD_STRIP);
+	//Top
+	glVertex3f(x - h, y + h, z - h);
+	glVertex3f(x + h, y + h, z - h);
+	glVertex3f(x - h, y + h, z + h);
+	glVertex3f(x + h, y + h, z + h);
+	//Front
+	glVertex3f(x - h, y - h, z + h);
+	glVertex3f(x + h, y - h, z + h);
+	//Bottom
+	glVertex3f(x - h, y - h, z - h);
+	glVertex3f(x + h, y - h, z - h);
+	//Back
+	glVertex3f(x - h, y + h, z - h);
+	glVertex3f(x + h, y + h, z - h);
+	
+	glEnd();
+	glBegin(GL_QUADS);
+	//Left
+	glVertex3f(x - h, y + h, z - h);
+	glVertex3f(x - h, y + h, z + h);
+	glVertex3f(x - h, y - h, z + h);
+	glVertex3f(x - h, y - h, z - h);
+	//Right
+	glVertex3f(x + h, y + h, z + h);
+	glVertex3f(x + h, y + h, z - h);
+	glVertex3f(x + h, y - h, z - h);
+	glVertex3f(x + h, y - h, z + h);
+
+	glEnd();
+}
+
 static int MessageDrawCallback(XPLMDrawingPhase inPhase, int inIsBefore, void * inRefcon)
 {
 	XPLMDrawString(rgb, msgX, msgY, msgVal, NULL, xplmFont_Basic);
@@ -26,6 +100,59 @@ static int MessageDrawCallback(XPLMDrawingPhase inPhase, int inIsBefore, void *
 	return 1;
 }
 
+static int RouteDrawCallback(XPLMDrawingPhase inPhase, int inIsBefore, void * inRefcon)
+{
+	float px = XPLMGetDataf(planeXref);
+	float py = XPLMGetDataf(planeYref);
+	float pz = XPLMGetDataf(planeZref);
+
+	Waypoint* g;
+	LocalPoint* l;
+	//Convert to local
+	for (size_t i = 0; i < numWaypoints; ++i)
+	{
+		g = &waypoints[i];
+		l = &localPoints[i];
+		XPLMWorldToLocal(g->lattitude, g->longitude, g->altitude,
+			&l->x, &l->y, &l->z);
+	}
+
+
+	//Draw posts
+	glColor3f(1.0F, 1.0F, 1.0F);
+	glBegin(GL_LINES);
+	for (size_t i = 0; i < numWaypoints; ++i)
+	{
+		l = &localPoints[i];
+		glVertex3f((float)l->x, (float)l->y, (float)l->z);
+		glVertex3f((float)l->x, -1000.0F, (float)l->z);
+	}
+	glEnd();
+
+	//Draw route
+	glColor3f(1.0F, 0.0F, 0.0F);
+	glBegin(GL_LINE_STRIP);
+	for (size_t i = 0; i < numWaypoints; ++i)
+	{
+		l = &localPoints[i];
+		glVertex3f((float)l->x, (float)l->y, (float)l->z);
+	}
+	glEnd();
+
+	//Draw markers
+	glColor3f(1.0F, 1.0F, 1.0F);
+	for (size_t i = 0; i < numWaypoints; ++i)
+	{
+		l = &localPoints[i];
+		float xoff = (float)l->x - px;
+		float yoff = (float)l->y - py;
+		float zoff = (float)l->z - pz;
+		float d = sqrtf(xoff*xoff + zoff*zoff);
+		gl_drawCube((float)l->x, (float)l->y, (float)l->z, d);
+	}
+	return 1;
+}
+
 //Public Functions
 void XPCClearMessage()
 {
@@ -37,7 +164,7 @@ void XPCSetMessage(int x, int y, char* msg)
 {
 	//Determine size of message and clear instead if the message string
 	//is empty.
-	size_t len = strnlen(msg, 255);
+	size_t len = strnlen(msg, MSG_MAX);
 	if (len == 0)
 	{
 		XPCClearMessage();
@@ -47,7 +174,7 @@ void XPCSetMessage(int x, int y, char* msg)
 	//Set the message, location, and mark new lines.
 	strncpy(msgVal, msg, len);
 	newLineCount = 0;
-	for (size_t i = 0; i < len && newLineCount < 64; ++i)
+	for (size_t i = 0; i < len && newLineCount < MSG_LINE_MAX; ++i)
 	{
 		if (msgVal[i] == '\n' || msgVal[i] == '\r')
 		{
@@ -64,4 +191,78 @@ void XPCSetMessage(int x, int y, char* msg)
 		XPLMRegisterDrawCallback(MessageDrawCallback, xplm_Phase_LastCockpit, 0, NULL);
 		msgEnabled = true;
 	}
+}
+
+void XPCClearWaypoints()
+{
+	numWaypoints = 0;
+	if (routeEnabled)
+	{
+		XPLMUnregisterDrawCallback(RouteDrawCallback, xplm_Phase_Objects, 0, NULL);
+	}
+	return;
+}
+
+void XPCAddWaypoints(Waypoint points[], size_t numPoints)
+{
+	if (numWaypoints + numPoints > WAYPOINT_MAX)
+	{
+		numPoints = WAYPOINT_MAX - numWaypoints;
+	}
+	size_t finalNumWaypoints = numPoints + numWaypoints;
+	for (size_t i = 0; i < numPoints; ++i)
+	{
+		waypoints[numWaypoints + i] = points[i];
+	}
+	numWaypoints = finalNumWaypoints;
+
+	if (!routeEnabled)
+	{
+		XPLMRegisterDrawCallback(RouteDrawCallback, xplm_Phase_Objects, 0, NULL);
+	}
+	if (!planeXref)
+	{
+		planeXref = XPLMFindDataRef("sim/flightmodel/position/local_x");
+		planeYref = XPLMFindDataRef("sim/flightmodel/position/local_y");
+		planeZref = XPLMFindDataRef("sim/flightmodel/position/local_z");
+	}
+}
+
+void XPCRemoveWaypoints(Waypoint points[], size_t numPoints)
+{
+	//Build a list of indices of waypoints we should delete.
+	size_t delPoints[WAYPOINT_MAX];
+	size_t delPointsCur = 0;
+	for (size_t i = 0; i < numPoints; ++i)
+	{
+		Waypoint p = points[i];
+		for (size_t j = 0; j < numWaypoints; ++j)
+		{
+			Waypoint q = waypoints[j];
+			if (p.lattitude == q.lattitude &&
+				p.longitude == q.longitude &&
+				p.altitude == q.altitude)
+			{
+				delPoints[delPointsCur++] = j;
+				break;
+			}
+		}
+	}
+	//Sort the indices so that we only have to iterate them once
+	qsort(delPoints, delPointsCur, sizeof(size_t), cmp);
+
+	//Copy the new array on top of the old array
+	size_t copyCur = 0;
+	size_t count = delPointsCur;
+	delPointsCur = 0;
+	for (size_t i = 0; i < count; ++i)
+	{
+		if (i == delPoints[delPointsCur])
+		{
+			++delPointsCur;
+			continue;
+		}
+		waypoints[copyCur++] = waypoints[i];
+	}
+	numWaypoints -= count;
 }

xpcPlugin/xpcDrawing.h

@@ -1,8 +1,23 @@
 #ifndef xpcDrawing_h
 #define xpcDrawing_h
 
+#include <stdlib.h>
+
+typedef struct
+{
+	double lattitude;
+	double longitude;
+	double altitude;
+} Waypoint;
+
 void XPCClearMessage();
 
 void XPCSetMessage(int x, int y, char* msg);
 
+void XPCClearWaypoints();
+
+void XPCAddWaypoints(Waypoint points[], size_t numPoints);
+
+void XPCRemoveWaypoints(Waypoint points[], size_t numPoints);
+
 #endif

xpcPlugin/xpcPlugin/xpcPlugin.vcxproj

@@ -71,6 +71,7 @@
     <Link>
       <SubSystem>Windows</SubSystem>
       <GenerateDebugInformation>true</GenerateDebugInformation>
+      <AdditionalDependencies>Opengl32.lib;%(AdditionalDependencies)</AdditionalDependencies>
     </Link>
   </ItemDefinitionGroup>
   <ItemDefinitionGroup Condition="'$(Configuration)|$(Platform)'=='Debug|x64'">
@@ -93,6 +94,7 @@
     <Link>
       <SubSystem>Windows</SubSystem>
       <GenerateDebugInformation>true</GenerateDebugInformation>
+      <AdditionalDependencies>OpenGL32.lib;%(AdditionalDependencies)</AdditionalDependencies>
     </Link>
   </ItemDefinitionGroup>
   <ItemGroup>