From 2c71143fd27ab876d7165df3f643bcad2664ccb0 Mon Sep 17 00:00:00 2001
From: Daniel Friesel <derf@finalrewind.org>
Date: Sat, 24 Dec 2011 02:54:20 +0100
Subject: Add wiispkr (play files on the wiimote speaker via libcwiimote)

---
 wiispkr.c | 96 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 96 insertions(+)
 create mode 100644 wiispkr.c

(limited to 'wiispkr.c')

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;
+}
-- 
cgit v1.2.3