X-Git-Url: http://git.mutantstargoat.com/user/nuclear/?a=blobdiff_plain;f=src%2Fmswin%2Ffg_spaceball_mswin.c;h=4d96c31a0b4265fe025a5d2bba38afa6db1ca837;hb=cae6701c343e3a42bc9504f14e6d83e4ca9d8119;hp=3726389f241dbcb3eeb09407586841488e23b5a8;hpb=7ce62fee66f89db514ed1b80e6c3aa287a2f8d74;p=freeglut

diff --git a/src/mswin/fg_spaceball_mswin.c b/src/mswin/fg_spaceball_mswin.c
index 3726389..4d96c31 100644
--- a/src/mswin/fg_spaceball_mswin.c
+++ b/src/mswin/fg_spaceball_mswin.c
@@ -2,11 +2,15 @@
  * fg_spaceball_mswin.c
  *
  * Spaceball support for Windows
- *
+ * 
  * Copyright (c) 2012 Stephen J. Baker. All Rights Reserved.
  * Written by Evan Felix <karcaw at gmail.com>
  * Creation date: Sat Feb 4, 2012
  *
+ * Copyright (c) 2014 Jinrong Xie. All Rights Reserved.
+ * Written by Jinrong Xie <stonexjr at gmail.com>
+ * Modification date: Wed Dec 24, 2014
+
  * Permission is hereby granted, free of charge, to any person obtaining a
  * copy of this software and associated documentation files (the "Software"),
  * to deal in the Software without restriction, including without limitation
@@ -24,16 +28,47 @@
  * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  */
+
 /*
- * This code is a very complicated way of doing nothing.  
- * But is needed for mswindows platform builds.
+ * This code is enhanced by at least supporting 3Dconnexion's 
+ * six degree of freedom navigator.
  */
 
 #include <GL/freeglut.h>
 #include "../fg_internal.h"
 
+enum {
+    SPNAV_EVENT_ANY,  
+    SPNAV_EVENT_MOTION_TRANSLATION,
+    SPNAV_EVENT_MOTION_ROTATION,
+    SPNAV_EVENT_BUTTON  /* includes both press and release */
+};
+
+extern int sball_initialized;
+unsigned int __fgSpaceKeystate = 0;
+RAWINPUTDEVICE __fgSpaceball = { 0x01, 0x08, 0x00, 0x00 };
+
 void fgPlatformInitializeSpaceball(void)
 {
+	HWND hwnd;
+    sball_initialized = 1;
+	if (!fgStructure.CurrentWindow)
+	{
+		sball_initialized = 0;
+		return;
+	}
+	hwnd = fgStructure.CurrentWindow->Window.Handle;
+
+	BOOL ok;
+	UINT cbSize = sizeof(__fgSpaceball);
+	__fgSpaceball.hwndTarget = hwnd;
+	ok = RegisterRawInputDevices(&__fgSpaceball, 1, cbSize);
+
+	if (!ok){
+		__fgSpaceball.hwndTarget = NULL;
+		sball_initialized = 0;
+	}
+
 	return;
 }
 
@@ -44,7 +79,7 @@ void fgPlatformSpaceballClose(void)
 
 int fgPlatformHasSpaceball(void)
 {
-	return 0;
+	return __fgSpaceball.hwndTarget ? 1 : 0;
 }
 
 int fgPlatformSpaceballNumButtons(void)
@@ -56,3 +91,101 @@ void fgPlatformSpaceballSetWindow(SFG_Window *window)
 {
 	return;
 }
+
+int fgIsSpaceballWinEvent(HWND hwnd, WPARAM wParam, LPARAM lParam)
+{
+}
+
+void fgSpaceballHandleWinEvent(HWND hwnd, WPARAM wParam, LPARAM lParam)
+{
+	#define LOGITECH_VENDOR_ID 0x46d
+	HRAWINPUT hRawInput = (HRAWINPUT)lParam;
+	UINT inputCode = (UINT)wParam;
+	RAWINPUTHEADER hdr;
+	UINT size;
+	BYTE *rawInputBuffer;
+	PRAWINPUT pRawInput;
+	UINT res;
+	RID_DEVICE_INFO sRidDeviceInfo;
+
+	if (!sball_initialized)
+	{
+		fgPlatformInitializeSpaceball();
+		if (!sball_initialized)
+		{
+			return;
+		}
+	}
+
+	res = GetRawInputData(hRawInput, RID_INPUT, NULL, &size, sizeof(RAWINPUTHEADER));
+	if (res == -1)
+		return;
+
+	rawInputBuffer = (BYTE*)malloc(size);
+	pRawInput = (PRAWINPUT)rawInputBuffer;
+
+	res = GetRawInputData(hRawInput, RID_INPUT, pRawInput, &size, sizeof(RAWINPUTHEADER));
+	if (res == -1)
+		return;
+	if (pRawInput->header.dwType != RIM_TYPEHID)
+		return;
+
+	sRidDeviceInfo.cbSize = sizeof(RID_DEVICE_INFO);
+	size = sizeof(RID_DEVICE_INFO);
+	res = GetRawInputDeviceInfo(pRawInput->header.hDevice, RIDI_DEVICEINFO, &sRidDeviceInfo, &size);
+	if (res == -1)
+		return;
+
+	SFG_Window* window = fgWindowByHandle(hwnd);
+	if ((window == NULL))
+		return;
+
+	if (sRidDeviceInfo.hid.dwVendorId == LOGITECH_VENDOR_ID)
+	{
+		// Motion data comes in two parts: motion type and 
+		// displacement/rotation along three axis.
+		// Orientation is a right handed coordinate system with 
+		// X goes right, Y goes up and Z goes towards viewer, e.g.
+		// the one used in OpenGL
+		if (pRawInput->data.hid.bRawData[0] == 
+			SPNAV_EVENT_MOTION_TRANSLATION)//0x01)
+		{ // Translation vector
+			short* pnData = (short*)(&pRawInput->data.hid.bRawData[1]);
+			short X =  pnData[0];
+			short Y = -pnData[2];
+			short Z =  pnData[1];
+			INVOKE_WCB(*window, SpaceMotion, (X, Y, Z));
+		}
+		else if (pRawInput->data.hid.bRawData[0] == 
+				SPNAV_EVENT_MOTION_ROTATION)//0x02)
+		{ // Axis aligned rotation vector
+			short* pnData = (short*)(&pRawInput->data.hid.bRawData[1]);
+			short rX =  pnData[0];
+			short rY = -pnData[2];
+			short rZ =  pnData[1];
+			INVOKE_WCB(*window, SpaceRotation, (rX, rY, rZ));
+		}
+		else if (pRawInput->data.hid.bRawData[0] == 
+				 SPNAV_EVENT_BUTTON)//0x03)
+		{ // State of the keys
+			unsigned long dwKeystate = *(unsigned long*)(&pRawInput->data.hid.bRawData[1]);
+			unsigned int state = GLUT_UP;
+			if (FETCH_WCB(*window, SpaceButton))
+			{
+				int i;
+				for (i = 0; i < 32; i++)
+				{
+					unsigned long stateBefore = __fgSpaceKeystate&(1 << i);
+					unsigned long stateNow = dwKeystate&(1 << i);
+
+					if (stateBefore && !stateNow)
+						INVOKE_WCB(*window, SpaceButton, (stateBefore, GLUT_DOWN));
+					if (!stateBefore && stateNow)
+						INVOKE_WCB(*window, SpaceButton, (stateNow, GLUT_UP));
+
+				}
+			}
+			__fgSpaceKeystate = dwKeystate;
+		}
+	}
+}
\ No newline at end of file