From 4cde0f8a6f8faa286c6f5f7e6473a56a77da4ad8 Mon Sep 17 00:00:00 2001 From: Daniel Friesel Date: Sat, 24 Dec 2011 18:28:27 +0100 Subject: wiispkr: Display (approximate) current volume on wiimote LEDs --- wiispkr.c | 74 +++++++++++++++++++++++++++++++++++++++++++++++++++++++-------- 1 file changed, 65 insertions(+), 9 deletions(-) (limited to 'wiispkr.c') diff --git a/wiispkr.c b/wiispkr.c index 7097cc0..a6b9722 100644 --- a/wiispkr.c +++ b/wiispkr.c @@ -23,6 +23,7 @@ #include #include #include +#include #include #include @@ -38,6 +39,30 @@ void print_sample(uint8_t *sample, int length) puts(""); } +double getvolume(uint8_t *sample, int length) +{ + uint64_t sum; + double rms; + static double minrms = 0, maxrms = 0; + static int skip = 0; + + if (skip != 10) { + skip++; + return 0.0; + } + + for (int i = 0; i < length; i++) + sum += (int8_t)sample[i] * (int8_t)sample[i]; + rms = sqrt(sum); + + if ((rms < minrms) || (minrms == 0)) + minrms = rms; + if ((rms > maxrms)) + maxrms = (rms + maxrms) / 2; + + return (rms - minrms) / (maxrms - minrms) * 5.0; +} + int main(int argc, char **argv) { wiimote_t wiimote = WIIMOTE_INIT; @@ -45,24 +70,29 @@ int main(int argc, char **argv) char report_err = 0; wiimote_report_t report = WIIMOTE_REPORT_INIT; - report.channel = WIIMOTE_RID_SPK; + wiimote_report_t reportl = WIIMOTE_REPORT_INIT; struct timeval tv; uint32_t timeout = 0; uint32_t t, start; uint32_t fpos = 0; + uint8_t ledbits = 0; + uint8_t cnt = 0; + uint8_t wmvolume = 0x40; uint8_t sample[20]; - - /* see http://wiibrew.org/wiki/Wiimote#Speaker_Configuration */ - uint8_t spk_8bit[] = { 0x00, 0x40, 0x70, 0x17, 0x60, 0x00, 0x00 }; - + double volume; if (argc < 2) { fprintf(stderr, "Usage: %s BDADDR < somefile.raw\n", argv[0]); return 1; } + if (argc >= 3) + wmvolume = atoi(argv[2]); + + /* see http://wiibrew.org/wiki/Wiimote#Speaker_Configuration */ + uint8_t spk_8bit[] = { 0x00, 0x40, 0x70, 0x17, wmvolume, 0x00, 0x00 }; puts("Press 1+2 to connect wiimote"); @@ -75,6 +105,8 @@ int main(int argc, char **argv) wiimote_update(&wiimote); + sleep(2); + wiimote_send_byte(&wiimote, WIIMOTE_RID_SPK_EN, 0x04); wiimote_send_byte(&wiimote, WIIMOTE_RID_SPK_MUTE, 0x04); wiimote_write_byte(&wiimote, 0x04a20009, 0x01); @@ -93,14 +125,38 @@ int main(int argc, char **argv) t = (tv.tv_sec * 1000000 + tv.tv_usec) / 100; if (t > timeout) { - printf("\r\033[2K%c play second %f pos %d", - (report_err ? '!' : ' '), - (double)(t - start) / 10000, fpos); - fflush(stdout); if ((readbytes = read(0, &sample, sizeof(sample))) < 1) return 0; fpos += readbytes; + volume = getvolume(sample, sizeof(sample)); + + switch ((uint8_t)volume) { + case 0: ledbits = 0x0; break; + case 1: ledbits = 0x1; break; + case 2: ledbits = 0x3; break; + case 3: ledbits = 0x7; break; + case 4: + case 5: ledbits = 0xf; break; + } + + printf("\r\033[2Kplaying %7.3f @ %6d \033[1m%c\033[0m ", + (double)(t - start) / 10000, + fpos, + (report_err ? '!' : ' ') + ); + fflush(stdout); + + if (cnt++ == 2) { + reportl.channel = WIIMOTE_RID_LEDS; + reportl.led.leds = ledbits; + reportl.led.rumble = 0; + + wiimote_report(&wiimote, &reportl, sizeof(reportl.led)); + cnt = 0; + } + + report.channel = WIIMOTE_RID_SPK; report.speaker.size = sizeof(sample); memcpy(report.speaker.data, sample, report.speaker.size); if (wiimote_report(&wiimote, &report, sizeof(report.speaker)) < 0) -- cgit v1.2.3