--- /dev/null
+/* Simple Raw HID functions for Windows - for use with Teensy RawHID example
+ * http://www.pjrc.com/teensy/rawhid.html
+ * Copyright (c) 2009 PJRC.COM, LLC
+ *
+ * rawhid_open - open 1 or more devices
+ * rawhid_recv - receive a packet
+ * rawhid_send - send a packet
+ * rawhid_close - close a device
+ *
+ * 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 the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above description, website URL and copyright notice and this permission
+ * notice shall be included in all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER 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.
+ *
+ * Version 1.0: Initial Release
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <stdint.h>
+#include <windows.h>
+#include <setupapi.h>
+#include <ddk/hidsdi.h>
+#include <ddk/hidclass.h>
+
+#include "hid.h"
+
+
+// a list of all opened HID devices, so the caller can
+// simply refer to them by number
+typedef struct hid_struct hid_t;
+static hid_t *first_hid = NULL;
+static hid_t *last_hid = NULL;
+struct hid_struct {
+ HANDLE handle;
+ int open;
+ struct hid_struct *prev;
+ struct hid_struct *next;
+};
+static HANDLE rx_event=NULL;
+static HANDLE tx_event=NULL;
+static CRITICAL_SECTION rx_mutex;
+static CRITICAL_SECTION tx_mutex;
+
+
+// private functions, not intended to be used from outside this file
+static void add_hid(hid_t *h);
+static hid_t * get_hid(int num);
+static void free_all_hid(void);
+static void hid_close(hid_t *hid);
+void print_win32_err(void);
+
+
+
+
+// rawhid_recv - receive a packet
+// Inputs:
+// num = device to receive from (zero based)
+// buf = buffer to receive packet
+// len = buffer's size
+// timeout = time to wait, in milliseconds
+// Output:
+// number of bytes received, or -1 on error
+//
+int rawhid_recv(int num, void *buf, int len, int timeout)
+{
+ hid_t *hid;
+ unsigned char tmpbuf[516];
+ OVERLAPPED ov;
+ DWORD n, r;
+
+ if (sizeof(tmpbuf) < len + 1) return -1;
+ hid = get_hid(num);
+ if (!hid || !hid->open) return -1;
+ EnterCriticalSection(&rx_mutex);
+ ResetEvent(&rx_event);
+ memset(&ov, 0, sizeof(ov));
+ ov.hEvent = rx_event;
+ if (!ReadFile(hid->handle, tmpbuf, len + 1, NULL, &ov)) {
+ if (GetLastError() != ERROR_IO_PENDING) goto return_error;
+ r = WaitForSingleObject(rx_event, timeout);
+ if (r == WAIT_TIMEOUT) goto return_timeout;
+ if (r != WAIT_OBJECT_0) goto return_error;
+ }
+ if (!GetOverlappedResult(hid->handle, &ov, &n, FALSE)) goto return_error;
+ LeaveCriticalSection(&rx_mutex);
+ if (n <= 0) return -1;
+ n--;
+ if (n > len) n = len;
+ memcpy(buf, tmpbuf + 1, n);
+ return n;
+return_timeout:
+ CancelIo(hid->handle);
+ LeaveCriticalSection(&rx_mutex);
+ return 0;
+return_error:
+ print_win32_err();
+ LeaveCriticalSection(&rx_mutex);
+ return -1;
+}
+
+// rawhid_send - send a packet
+// Inputs:
+// num = device to transmit to (zero based)
+// buf = buffer containing packet to send
+// len = number of bytes to transmit
+// timeout = time to wait, in milliseconds
+// Output:
+// number of bytes sent, or -1 on error
+//
+int rawhid_send(int num, void *buf, int len, int timeout)
+{
+ hid_t *hid;
+ unsigned char tmpbuf[516];
+ OVERLAPPED ov;
+ DWORD n, r;
+
+ if (sizeof(tmpbuf) < len + 1) return -1;
+ hid = get_hid(num);
+ if (!hid || !hid->open) return -1;
+ EnterCriticalSection(&tx_mutex);
+ ResetEvent(&tx_event);
+ memset(&ov, 0, sizeof(ov));
+ ov.hEvent = tx_event;
+ tmpbuf[0] = 0;
+ memcpy(tmpbuf + 1, buf, len);
+ if (!WriteFile(hid->handle, tmpbuf, len + 1, NULL, &ov)) {
+ if (GetLastError() != ERROR_IO_PENDING) goto return_error;
+ r = WaitForSingleObject(tx_event, timeout);
+ if (r == WAIT_TIMEOUT) goto return_timeout;
+ if (r != WAIT_OBJECT_0) goto return_error;
+ }
+ if (!GetOverlappedResult(hid->handle, &ov, &n, FALSE)) goto return_error;
+ LeaveCriticalSection(&tx_mutex);
+ if (n <= 0) return -1;
+ return n - 1;
+return_timeout:
+ CancelIo(hid->handle);
+ LeaveCriticalSection(&tx_mutex);
+ return 0;
+return_error:
+ print_win32_err();
+ LeaveCriticalSection(&tx_mutex);
+ return -1;
+}
+
+// rawhid_open - open 1 or more devices
+//
+// Inputs:
+// max = maximum number of devices to open
+// vid = Vendor ID, or -1 if any
+// pid = Product ID, or -1 if any
+// usage_page = top level usage page, or -1 if any
+// usage = top level usage number, or -1 if any
+// Output:
+// actual number of devices opened
+//
+int rawhid_open(int max, int vid, int pid, int usage_page, int usage)
+{
+ GUID guid;
+ HDEVINFO info;
+ DWORD index=0, reqd_size;
+ SP_DEVICE_INTERFACE_DATA iface;
+ SP_DEVICE_INTERFACE_DETAIL_DATA *details;
+ HIDD_ATTRIBUTES attrib;
+ PHIDP_PREPARSED_DATA hid_data;
+ HIDP_CAPS capabilities;
+ HANDLE h;
+ BOOL ret;
+ hid_t *hid;
+ int count=0;
+
+ if (first_hid) free_all_hid();
+ if (max < 1) return 0;
+ if (!rx_event) {
+ rx_event = CreateEvent(NULL, TRUE, TRUE, NULL);
+ tx_event = CreateEvent(NULL, TRUE, TRUE, NULL);
+ InitializeCriticalSection(&rx_mutex);
+ InitializeCriticalSection(&tx_mutex);
+ }
+ HidD_GetHidGuid(&guid);
+ info = SetupDiGetClassDevs(&guid, NULL, NULL, DIGCF_PRESENT | DIGCF_DEVICEINTERFACE);
+ if (info == INVALID_HANDLE_VALUE) return 0;
+ for (index=0; 1 ;index++) {
+ iface.cbSize = sizeof(SP_DEVICE_INTERFACE_DATA);
+ ret = SetupDiEnumDeviceInterfaces(info, NULL, &guid, index, &iface);
+ if (!ret) return count;
+ SetupDiGetInterfaceDeviceDetail(info, &iface, NULL, 0, &reqd_size, NULL);
+ details = (SP_DEVICE_INTERFACE_DETAIL_DATA *)malloc(reqd_size);
+ if (details == NULL) continue;
+
+ memset(details, 0, reqd_size);
+ details->cbSize = sizeof(SP_DEVICE_INTERFACE_DETAIL_DATA);
+ ret = SetupDiGetDeviceInterfaceDetail(info, &iface, details,
+ reqd_size, NULL, NULL);
+ if (!ret) {
+ free(details);
+ continue;
+ }
+ h = CreateFile(details->DevicePath, GENERIC_READ|GENERIC_WRITE,
+ FILE_SHARE_READ|FILE_SHARE_WRITE, NULL,
+ OPEN_EXISTING, FILE_FLAG_OVERLAPPED, NULL);
+ free(details);
+ if (h == INVALID_HANDLE_VALUE) continue;
+ attrib.Size = sizeof(HIDD_ATTRIBUTES);
+ ret = HidD_GetAttributes(h, &attrib);
+ //printf("vid: %4x\n", attrib.VendorID);
+ if (!ret || (vid > 0 && attrib.VendorID != vid) ||
+ (pid > 0 && attrib.ProductID != pid) ||
+ !HidD_GetPreparsedData(h, &hid_data)) {
+ CloseHandle(h);
+ continue;
+ }
+ if (!HidP_GetCaps(hid_data, &capabilities) ||
+ (usage_page > 0 && capabilities.UsagePage != usage_page) ||
+ (usage > 0 && capabilities.Usage != usage)) {
+ HidD_FreePreparsedData(hid_data);
+ CloseHandle(h);
+ continue;
+ }
+ HidD_FreePreparsedData(hid_data);
+ hid = (struct hid_struct *)malloc(sizeof(struct hid_struct));
+ if (!hid) {
+ CloseHandle(h);
+ continue;
+ }
+ hid->handle = h;
+ hid->open = 1;
+ add_hid(hid);
+ count++;
+ if (count >= max) return count;
+ }
+ return count;
+}
+
+
+// rawhid_close - close a device
+//
+// Inputs:
+// num = device to close (zero based)
+// Output
+// (nothing)
+//
+void rawhid_close(int num)
+{
+ hid_t *hid;
+
+ hid = get_hid(num);
+ if (!hid || !hid->open) return;
+ hid_close(hid);
+}
+
+
+
+static void add_hid(hid_t *h)
+{
+ if (!first_hid || !last_hid) {
+ first_hid = last_hid = h;
+ h->next = h->prev = NULL;
+ return;
+ }
+ last_hid->next = h;
+ h->prev = last_hid;
+ h->next = NULL;
+ last_hid = h;
+}
+
+
+static hid_t * get_hid(int num)
+{
+ hid_t *p;
+ for (p = first_hid; p && num > 0; p = p->next, num--) ;
+ return p;
+}
+
+
+static void free_all_hid(void)
+{
+ hid_t *p, *q;
+
+ for (p = first_hid; p; p = p->next) {
+ hid_close(p);
+ }
+ p = first_hid;
+ while (p) {
+ q = p;
+ p = p->next;
+ free(q);
+ }
+ first_hid = last_hid = NULL;
+}
+
+
+static void hid_close(hid_t *hid)
+{
+ CloseHandle(hid->handle);
+ hid->handle = NULL;
+}
+
+
+void print_win32_err(void)
+{
+ char buf[256];
+ DWORD err;
+
+ err = GetLastError();
+ FormatMessage(FORMAT_MESSAGE_FROM_SYSTEM, NULL, err,
+ 0, buf, sizeof(buf), NULL);
+ printf("err %ld: %s\n", err, buf);
+}
+
+
+
+
+
projects / svn42.git / blobdiff