From 89a936eb754347c2037b07f74fc23bdc8e1a2b31 Mon Sep 17 00:00:00 2001
From: Daniel Friesel <derf@finalrewind.org>
Date: Sat, 17 Dec 2011 03:44:34 +0100
Subject: Add mplog

---
 mplog.c | 63 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 63 insertions(+)
 create mode 100644 mplog.c

diff --git a/mplog.c b/mplog.c
new file mode 100644
index 0000000..0b43b0a
--- /dev/null
+++ b/mplog.c
@@ -0,0 +1,63 @@
+/*
+ * Copyright (C) 2011 by Daniel Friesel <derf@finalrewind.org>
+ * License: WTFPL <http://sam.zoy.org/wtfpl>
+ *   0. You just DO WHAT THE FUCK YOU WANT TO.
+ */
+
+#include <stdlib.h>
+#include <stdio.h>
+#include <unistd.h>
+#include <time.h>
+#include <math.h>
+#include <bluetooth/bluetooth.h>
+#include <cwiid.h>
+
+cwiid_mesg_callback_t cwiid_callback;
+
+int main()
+{
+	cwiid_wiimote_t *wiimote = NULL;
+
+	if ((wiimote = cwiid_open(BDADDR_ANY, 0)) == NULL) {
+		fputs("Unable to connect\n", stderr);
+		return EXIT_FAILURE;
+	}
+
+	sleep(2);
+
+	cwiid_set_led(wiimote, (1 << 3) | (1));
+
+	if (cwiid_set_mesg_callback(wiimote, cwiid_callback))
+		fputs("cannot set callback\n", stderr);
+	
+	cwiid_enable(wiimote, CWIID_FLAG_MOTIONPLUS);
+
+	if (cwiid_enable(wiimote, CWIID_FLAG_MESG_IFC))
+		fputs("cannot enable callback\n", stderr);
+
+	if (cwiid_set_rpt_mode(wiimote,
+			CWIID_RPT_EXT))
+		fputs("cannot set report mode\n", stderr);
+
+	while (1) {
+		/* nothing to do here */
+		sleep(1);
+	}
+
+	return EXIT_SUCCESS;
+}
+
+void cwiid_callback(cwiid_wiimote_t *wiimote, int mesg_count,
+	union cwiid_mesg mesg[], struct timespec *ts)
+{
+	for (int i = 0; i < mesg_count; i++) {
+		if (mesg[i].type == CWIID_MESG_MOTIONPLUS) {
+			printf("%ld.%09ld %d %d %d\n", ts->tv_sec, ts->tv_nsec,
+				mesg[i].motionplus_mesg.angle_rate[0],
+				mesg[i].motionplus_mesg.angle_rate[1],
+				mesg[i].motionplus_mesg.angle_rate[2]
+			);
+		}
+	}
+}
+
-- 
cgit v1.2.3