xref: /qemu/hw/audio/pcspk.c (revision db895a1e6a97e919f9b86d60c969377357b05066)
1fd06c375Sbellard /*
2fd06c375Sbellard  * QEMU PC speaker emulation
3fd06c375Sbellard  *
4fd06c375Sbellard  * Copyright (c) 2006 Joachim Henke
5fd06c375Sbellard  *
6fd06c375Sbellard  * Permission is hereby granted, free of charge, to any person obtaining a copy
7fd06c375Sbellard  * of this software and associated documentation files (the "Software"), to deal
8fd06c375Sbellard  * in the Software without restriction, including without limitation the rights
9fd06c375Sbellard  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10fd06c375Sbellard  * copies of the Software, and to permit persons to whom the Software is
11fd06c375Sbellard  * furnished to do so, subject to the following conditions:
12fd06c375Sbellard  *
13fd06c375Sbellard  * The above copyright notice and this permission notice shall be included in
14fd06c375Sbellard  * all copies or substantial portions of the Software.
15fd06c375Sbellard  *
16fd06c375Sbellard  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17fd06c375Sbellard  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18fd06c375Sbellard  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19fd06c375Sbellard  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20fd06c375Sbellard  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21fd06c375Sbellard  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22fd06c375Sbellard  * THE SOFTWARE.
23fd06c375Sbellard  */
24fd06c375Sbellard 
2583c9f4caSPaolo Bonzini #include "hw/hw.h"
260d09e41aSPaolo Bonzini #include "hw/i386/pc.h"
270d09e41aSPaolo Bonzini #include "hw/isa/isa.h"
2836cd6f6fSPaolo Bonzini #include "hw/audio/audio.h"
2987ecb68bSpbrook #include "audio/audio.h"
301de7afc9SPaolo Bonzini #include "qemu/timer.h"
310d09e41aSPaolo Bonzini #include "hw/timer/i8254.h"
320d09e41aSPaolo Bonzini #include "hw/audio/pcspk.h"
33fd06c375Sbellard 
34fd06c375Sbellard #define PCSPK_BUF_LEN 1792
35fd06c375Sbellard #define PCSPK_SAMPLE_RATE 32000
36fd06c375Sbellard #define PCSPK_MAX_FREQ (PCSPK_SAMPLE_RATE >> 1)
37fd06c375Sbellard #define PCSPK_MIN_COUNT ((PIT_FREQ + PCSPK_MAX_FREQ - 1) / PCSPK_MAX_FREQ)
38fd06c375Sbellard 
39d367ece5SAndreas Färber #define PC_SPEAKER(obj) OBJECT_CHECK(PCSpkState, (obj), TYPE_PC_SPEAKER)
40d367ece5SAndreas Färber 
41fd06c375Sbellard typedef struct {
42d367ece5SAndreas Färber     ISADevice parent_obj;
43d367ece5SAndreas Färber 
44302fe51bSJan Kiszka     MemoryRegion ioport;
45302fe51bSJan Kiszka     uint32_t iobase;
46fd06c375Sbellard     uint8_t sample_buf[PCSPK_BUF_LEN];
47fd06c375Sbellard     QEMUSoundCard card;
48fd06c375Sbellard     SWVoiceOut *voice;
49302fe51bSJan Kiszka     void *pit;
50fd06c375Sbellard     unsigned int pit_count;
51fd06c375Sbellard     unsigned int samples;
52fd06c375Sbellard     unsigned int play_pos;
53fd06c375Sbellard     int data_on;
54fd06c375Sbellard     int dummy_refresh_clock;
55fd06c375Sbellard } PCSpkState;
56fd06c375Sbellard 
57fd06c375Sbellard static const char *s_spk = "pcspk";
58302fe51bSJan Kiszka static PCSpkState *pcspk_state;
59fd06c375Sbellard 
60fd06c375Sbellard static inline void generate_samples(PCSpkState *s)
61fd06c375Sbellard {
62fd06c375Sbellard     unsigned int i;
63fd06c375Sbellard 
64fd06c375Sbellard     if (s->pit_count) {
65fd06c375Sbellard         const uint32_t m = PCSPK_SAMPLE_RATE * s->pit_count;
66fd06c375Sbellard         const uint32_t n = ((uint64_t)PIT_FREQ << 32) / m;
67fd06c375Sbellard 
68fd06c375Sbellard         /* multiple of wavelength for gapless looping */
69fd06c375Sbellard         s->samples = (PCSPK_BUF_LEN * PIT_FREQ / m * m / (PIT_FREQ >> 1) + 1) >> 1;
70fd06c375Sbellard         for (i = 0; i < s->samples; ++i)
71fd06c375Sbellard             s->sample_buf[i] = (64 & (n * i >> 25)) - 32;
72fd06c375Sbellard     } else {
73fd06c375Sbellard         s->samples = PCSPK_BUF_LEN;
74fd06c375Sbellard         for (i = 0; i < PCSPK_BUF_LEN; ++i)
75fd06c375Sbellard             s->sample_buf[i] = 128; /* silence */
76fd06c375Sbellard     }
77fd06c375Sbellard }
78fd06c375Sbellard 
79fd06c375Sbellard static void pcspk_callback(void *opaque, int free)
80fd06c375Sbellard {
81fd06c375Sbellard     PCSpkState *s = opaque;
824aa5d285SJan Kiszka     PITChannelInfo ch;
83fd06c375Sbellard     unsigned int n;
84fd06c375Sbellard 
854aa5d285SJan Kiszka     pit_get_channel_info(s->pit, 2, &ch);
86fd06c375Sbellard 
874aa5d285SJan Kiszka     if (ch.mode != 3) {
884aa5d285SJan Kiszka         return;
894aa5d285SJan Kiszka     }
904aa5d285SJan Kiszka 
914aa5d285SJan Kiszka     n = ch.initial_count;
92fd06c375Sbellard     /* avoid frequencies that are not reproducible with sample rate */
93fd06c375Sbellard     if (n < PCSPK_MIN_COUNT)
94fd06c375Sbellard         n = 0;
95fd06c375Sbellard 
96fd06c375Sbellard     if (s->pit_count != n) {
97fd06c375Sbellard         s->pit_count = n;
98fd06c375Sbellard         s->play_pos = 0;
99fd06c375Sbellard         generate_samples(s);
100fd06c375Sbellard     }
101fd06c375Sbellard 
102fd06c375Sbellard     while (free > 0) {
103fd06c375Sbellard         n = audio_MIN(s->samples - s->play_pos, (unsigned int)free);
104fd06c375Sbellard         n = AUD_write(s->voice, &s->sample_buf[s->play_pos], n);
105fd06c375Sbellard         if (!n)
106fd06c375Sbellard             break;
107fd06c375Sbellard         s->play_pos = (s->play_pos + n) % s->samples;
108fd06c375Sbellard         free -= n;
109fd06c375Sbellard     }
110fd06c375Sbellard }
111fd06c375Sbellard 
11236cd6f6fSPaolo Bonzini static int pcspk_audio_init(ISABus *bus)
113fd06c375Sbellard {
114302fe51bSJan Kiszka     PCSpkState *s = pcspk_state;
1151ea879e5Smalc     struct audsettings as = {PCSPK_SAMPLE_RATE, 1, AUD_FMT_U8, 0};
116fd06c375Sbellard 
1171a7dafceSmalc     AUD_register_card(s_spk, &s->card);
118fd06c375Sbellard 
119d929eba5Sbellard     s->voice = AUD_open_out(&s->card, s->voice, s_spk, s, pcspk_callback, &as);
120fd06c375Sbellard     if (!s->voice) {
121fd06c375Sbellard         AUD_log(s_spk, "Could not open voice\n");
122fd06c375Sbellard         return -1;
123fd06c375Sbellard     }
124fd06c375Sbellard 
125fd06c375Sbellard     return 0;
126fd06c375Sbellard }
127fd06c375Sbellard 
128a8170e5eSAvi Kivity static uint64_t pcspk_io_read(void *opaque, hwaddr addr,
129302fe51bSJan Kiszka                               unsigned size)
130fd06c375Sbellard {
131fd06c375Sbellard     PCSpkState *s = opaque;
1324aa5d285SJan Kiszka     PITChannelInfo ch;
1334aa5d285SJan Kiszka 
1344aa5d285SJan Kiszka     pit_get_channel_info(s->pit, 2, &ch);
135fd06c375Sbellard 
136fd06c375Sbellard     s->dummy_refresh_clock ^= (1 << 4);
137fd06c375Sbellard 
1384aa5d285SJan Kiszka     return ch.gate | (s->data_on << 1) | s->dummy_refresh_clock |
1394aa5d285SJan Kiszka        (ch.out << 5);
140fd06c375Sbellard }
141fd06c375Sbellard 
142a8170e5eSAvi Kivity static void pcspk_io_write(void *opaque, hwaddr addr, uint64_t val,
143302fe51bSJan Kiszka                            unsigned size)
144fd06c375Sbellard {
145fd06c375Sbellard     PCSpkState *s = opaque;
146fd06c375Sbellard     const int gate = val & 1;
147fd06c375Sbellard 
148fd06c375Sbellard     s->data_on = (val >> 1) & 1;
149fd06c375Sbellard     pit_set_gate(s->pit, 2, gate);
150fd06c375Sbellard     if (s->voice) {
151fd06c375Sbellard         if (gate) /* restart */
152fd06c375Sbellard             s->play_pos = 0;
153fd06c375Sbellard         AUD_set_active_out(s->voice, gate & s->data_on);
154fd06c375Sbellard     }
155fd06c375Sbellard }
156fd06c375Sbellard 
157302fe51bSJan Kiszka static const MemoryRegionOps pcspk_io_ops = {
158302fe51bSJan Kiszka     .read = pcspk_io_read,
159302fe51bSJan Kiszka     .write = pcspk_io_write,
160302fe51bSJan Kiszka     .impl = {
161302fe51bSJan Kiszka         .min_access_size = 1,
162302fe51bSJan Kiszka         .max_access_size = 1,
163302fe51bSJan Kiszka     },
164302fe51bSJan Kiszka };
165fd06c375Sbellard 
166*db895a1eSAndreas Färber static void pcspk_initfn(Object *obj)
167302fe51bSJan Kiszka {
168*db895a1eSAndreas Färber     PCSpkState *s = PC_SPEAKER(obj);
169302fe51bSJan Kiszka 
170302fe51bSJan Kiszka     memory_region_init_io(&s->ioport, &pcspk_io_ops, s, "elcr", 1);
171*db895a1eSAndreas Färber }
172*db895a1eSAndreas Färber 
173*db895a1eSAndreas Färber static void pcspk_realizefn(DeviceState *dev, Error **errp)
174*db895a1eSAndreas Färber {
175*db895a1eSAndreas Färber     ISADevice *isadev = ISA_DEVICE(dev);
176*db895a1eSAndreas Färber     PCSpkState *s = PC_SPEAKER(dev);
177*db895a1eSAndreas Färber 
178*db895a1eSAndreas Färber     isa_register_ioport(isadev, &s->ioport, s->iobase);
179302fe51bSJan Kiszka 
180302fe51bSJan Kiszka     pcspk_state = s;
181fd06c375Sbellard }
182302fe51bSJan Kiszka 
183302fe51bSJan Kiszka static Property pcspk_properties[] = {
184302fe51bSJan Kiszka     DEFINE_PROP_HEX32("iobase", PCSpkState, iobase,  -1),
185302fe51bSJan Kiszka     DEFINE_PROP_PTR("pit", PCSpkState, pit),
186302fe51bSJan Kiszka     DEFINE_PROP_END_OF_LIST(),
187302fe51bSJan Kiszka };
188302fe51bSJan Kiszka 
189302fe51bSJan Kiszka static void pcspk_class_initfn(ObjectClass *klass, void *data)
190302fe51bSJan Kiszka {
191302fe51bSJan Kiszka     DeviceClass *dc = DEVICE_CLASS(klass);
192302fe51bSJan Kiszka 
193*db895a1eSAndreas Färber     dc->realize = pcspk_realizefn;
194302fe51bSJan Kiszka     dc->no_user = 1;
195302fe51bSJan Kiszka     dc->props = pcspk_properties;
196302fe51bSJan Kiszka }
197302fe51bSJan Kiszka 
1988c43a6f0SAndreas Färber static const TypeInfo pcspk_info = {
199d367ece5SAndreas Färber     .name           = TYPE_PC_SPEAKER,
200302fe51bSJan Kiszka     .parent         = TYPE_ISA_DEVICE,
201302fe51bSJan Kiszka     .instance_size  = sizeof(PCSpkState),
202*db895a1eSAndreas Färber     .instance_init  = pcspk_initfn,
203302fe51bSJan Kiszka     .class_init     = pcspk_class_initfn,
204302fe51bSJan Kiszka };
205302fe51bSJan Kiszka 
206302fe51bSJan Kiszka static void pcspk_register(void)
207302fe51bSJan Kiszka {
208302fe51bSJan Kiszka     type_register_static(&pcspk_info);
20936cd6f6fSPaolo Bonzini     isa_register_soundhw("pcspk", "PC speaker", pcspk_audio_init);
210302fe51bSJan Kiszka }
211302fe51bSJan Kiszka type_init(pcspk_register)
212