Fix wrong signedness, by Andre Przywara.
[qemu] / audio / wavcapture.c
1 #include "hw/hw.h"
2 #include "console.h"
3 #include "audio.h"
4
5 typedef struct {
6     QEMUFile *f;
7     int bytes;
8     char *path;
9     int freq;
10     int bits;
11     int nchannels;
12     CaptureVoiceOut *cap;
13 } WAVState;
14
15 /* VICE code: Store number as little endian. */
16 static void le_store (uint8_t *buf, uint32_t val, int len)
17 {
18     int i;
19     for (i = 0; i < len; i++) {
20         buf[i] = (uint8_t) (val & 0xff);
21         val >>= 8;
22     }
23 }
24
25 static void wav_notify (void *opaque, audcnotification_e cmd)
26 {
27     (void) opaque;
28     (void) cmd;
29 }
30
31 static void wav_destroy (void *opaque)
32 {
33     WAVState *wav = opaque;
34     uint8_t rlen[4];
35     uint8_t dlen[4];
36     uint32_t datalen = wav->bytes;
37     uint32_t rifflen = datalen + 36;
38
39     if (wav->f) {
40         le_store (rlen, rifflen, 4);
41         le_store (dlen, datalen, 4);
42
43         qemu_fseek (wav->f, 4, SEEK_SET);
44         qemu_put_buffer (wav->f, rlen, 4);
45
46         qemu_fseek (wav->f, 32, SEEK_CUR);
47         qemu_put_buffer (wav->f, dlen, 4);
48         qemu_fclose (wav->f);
49     }
50
51     qemu_free (wav->path);
52 }
53
54 static void wav_capture (void *opaque, void *buf, int size)
55 {
56     WAVState *wav = opaque;
57
58     qemu_put_buffer (wav->f, buf, size);
59     wav->bytes += size;
60 }
61
62 static void wav_capture_destroy (void *opaque)
63 {
64     WAVState *wav = opaque;
65
66     AUD_del_capture (wav->cap, wav);
67 }
68
69 static void wav_capture_info (void *opaque)
70 {
71     WAVState *wav = opaque;
72     char *path = wav->path;
73
74     term_printf ("Capturing audio(%d,%d,%d) to %s: %d bytes\n",
75                  wav->freq, wav->bits, wav->nchannels,
76                  path ? path : "<not available>", wav->bytes);
77 }
78
79 static struct capture_ops wav_capture_ops = {
80     .destroy = wav_capture_destroy,
81     .info = wav_capture_info
82 };
83
84 int wav_start_capture (CaptureState *s, const char *path, int freq,
85                        int bits, int nchannels)
86 {
87     WAVState *wav;
88     uint8_t hdr[] = {
89         0x52, 0x49, 0x46, 0x46, 0x00, 0x00, 0x00, 0x00, 0x57, 0x41, 0x56,
90         0x45, 0x66, 0x6d, 0x74, 0x20, 0x10, 0x00, 0x00, 0x00, 0x01, 0x00,
91         0x02, 0x00, 0x44, 0xac, 0x00, 0x00, 0x10, 0xb1, 0x02, 0x00, 0x04,
92         0x00, 0x10, 0x00, 0x64, 0x61, 0x74, 0x61, 0x00, 0x00, 0x00, 0x00
93     };
94     audsettings_t as;
95     struct audio_capture_ops ops;
96     int stereo, bits16, shift;
97     CaptureVoiceOut *cap;
98
99     if (bits != 8 && bits != 16) {
100         term_printf ("incorrect bit count %d, must be 8 or 16\n", bits);
101         return -1;
102     }
103
104     if (nchannels != 1 && nchannels != 2) {
105         term_printf ("incorrect channel count %d, must be 1 or 2\n",
106                      nchannels);
107         return -1;
108     }
109
110     stereo = nchannels == 2;
111     bits16 = bits == 16;
112
113     as.freq = freq;
114     as.nchannels = 1 << stereo;
115     as.fmt = bits16 ? AUD_FMT_S16 : AUD_FMT_U8;
116     as.endianness = 0;
117
118     ops.notify = wav_notify;
119     ops.capture = wav_capture;
120     ops.destroy = wav_destroy;
121
122     wav = qemu_mallocz (sizeof (*wav));
123     if (!wav) {
124         term_printf ("Could not allocate memory for wav capture (%zu bytes)",
125                      sizeof (*wav));
126         return -1;
127     }
128
129     shift = bits16 + stereo;
130     hdr[34] = bits16 ? 0x10 : 0x08;
131
132     le_store (hdr + 22, as.nchannels, 2);
133     le_store (hdr + 24, freq, 4);
134     le_store (hdr + 28, freq << shift, 4);
135     le_store (hdr + 32, 1 << shift, 2);
136
137     wav->f = qemu_fopen (path, "wb");
138     if (!wav->f) {
139         term_printf ("Failed to open wave file `%s'\nReason: %s\n",
140                      path, strerror (errno));
141         qemu_free (wav);
142         return -1;
143     }
144
145     wav->path = qemu_strdup (path);
146     wav->bits = bits;
147     wav->nchannels = nchannels;
148     wav->freq = freq;
149
150     qemu_put_buffer (wav->f, hdr, sizeof (hdr));
151
152     cap = AUD_add_capture (NULL, &as, &ops, wav);
153     if (!cap) {
154         term_printf ("Failed to add audio capture\n");
155         qemu_free (wav->path);
156         qemu_fclose (wav->f);
157         qemu_free (wav);
158         return -1;
159     }
160
161     wav->cap = cap;
162     s->opaque = wav;
163     s->ops = wav_capture_ops;
164     return 0;
165 }