Add wiispkr (play files on the wiimote speaker via libcwiimote)

3 files changed, 101 insertions, 1 deletions

diff --git a/.gitignore b/.gitignore
index 070bede..2465242 100644
--- a/.gitignore
+++ b/.gitignore
@@ -2,3 +2,4 @@
 /mpcal
 /mplog
 /wibble
+/wiispkr
diff --git a/Makefile b/Makefile
index 55a77cc..2f9f4ac 100644
--- a/Makefile
+++ b/Makefile
@@ -1,7 +1,7 @@
 CFLAGS = -Wall -Wextra -pedantic -Wno-unused-parameter
 LDFLAGS = -lbluetooth -lcwiid
 
-all: bal mpcal mplog wibble
+all: bal mpcal mplog wibble wiispkr
 
 bal: bal.c
 	${CC} ${CFLAGS} ${LDFLAGS} -o $@ $<
@@ -15,6 +15,9 @@ mplog: mplog.c
 wibble: wibble.c
 	${CC} ${CFLAGS} ${LDFLAGS} -lm -o $@ $<
 
+wiispkr: wiispkr.c
+	${CC} ${CFLAGS} -lm -lbluetooth -lcwiimote -o $@ $<
+
 clean:
 	rm -f bal mplog wibble
 
diff --git a/wiispkr.c b/wiispkr.c
new file mode 100644
index 0000000..1ee5370
--- /dev/null
+++ b/wiispkr.c
@@ -0,0 +1,96 @@
+/*
+ * Copyright (C) 2011 by Daniel Friesel <derf@finalrewind.org>
+ * License: WTFPL:
+ *   0. You just DO WHAT THE FUCK YOU WANT TO
+ *
+ * Loosely based on libcwiimote/test/test2.c
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <sys/stat.h>
+#include <sys/time.h>
+#include <sys/types.h>
+#include <time.h>
+#include <fcntl.h>
+
+#include <libcwiimote/wiimote.h>
+#include <libcwiimote/wiimote_api.h>
+
+#define SPK_REG_CFG		0x04a20001
+#define SPK_REG_VOL		0x04a20005
+#define SPK_REG_FREQ	0x04a20004
+
+void print_sample(uint8_t *sample, int length)
+{
+	for (int i = 0; i < length; i++)
+		printf("%02x, ", sample[i]);
+	puts("");
+}
+
+int main(int argc, char **argv)
+{
+	wiimote_t wiimote = WIIMOTE_INIT;
+	int readbytes;
+
+	struct timeval tv;
+	uint32_t timeout = 0;
+	uint32_t t, start;
+
+	uint32_t fpos = 0;
+	
+	uint8_t sample[20];
+
+	uint8_t spk_8bit[] = { 0x00, 0x40, 0x40, 0x1f, 0x60, 0x00, 0x00 };
+	uint8_t spk_4bit[] = { 0x00, 0x00, 0xd0, 0x07, 0x40, 0x00, 0x00 };
+
+
+	if (argc < 2) {
+		fprintf(stderr, "Usage: %s BDADDR < somefile.raw\n", argv[0]);
+		return 1;
+	}
+	
+	puts("Press 1+2 to connect wiimote");
+	
+	if (wiimote_connect(&wiimote, argv[1]) < 0) {
+		fprintf(stderr, "unable to open wiimote: %s\n", wiimote_get_error());
+		exit(1);
+	}
+
+	wiimote.led.one  = 1;
+	
+	wiimote_update(&wiimote);
+
+	wiimote_send_byte(&wiimote, WIIMOTE_RID_SPK_EN, 0x04);
+	wiimote_send_byte(&wiimote, WIIMOTE_RID_SPK_MUTE, 0x04);
+	wiimote_write_byte(&wiimote, 0x04a20009, 0x01);
+	wiimote_write_byte(&wiimote, 0x04a20001, 0x08);
+
+	wiimote_write(&wiimote, 0x04a20001, spk_8bit, sizeof(spk_4bit));
+
+	wiimote_write_byte(&wiimote, 0x04a20008, 0x01);
+	wiimote_send_byte(&wiimote, WIIMOTE_RID_SPK_MUTE, 0x00);
+
+	gettimeofday(&tv, NULL);
+	start = (tv.tv_sec * 1000000 + tv.tv_usec) / 100;
+
+	while (wiimote_is_open(&wiimote)) {
+		gettimeofday(&tv,NULL);
+		t = (tv.tv_sec * 1000000 + tv.tv_usec) / 100;
+
+		if (t > timeout) {
+			printf("play second %f pos %d\n", (double)(t - start) / 10000, fpos);
+			if ((readbytes = read(0, &sample, sizeof(sample))) == -1)
+				return 0;
+			fpos += readbytes;
+			print_sample(sample, sizeof(sample));
+			wiimote_speaker_play(&wiimote, sample, sizeof(sample));
+			timeout = t + 130;
+		}
+		else
+			usleep(timeout - t);
+	}
+	
+	return 0;
+}