1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
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;
}
|
