]>
Commit | Line | Data |
---|---|---|
e8482f24 GL |
1 | // -------------------------------------------------------------------------- |
2 | // Name: sndg72x.cpp | |
3 | // Purpose: | |
4 | // Date: 08/26/1999 | |
5 | // Author: Guilhem Lavaux <lavaux@easynet.fr> (C) 1999 | |
6 | // CVSID: $Id$ | |
7 | // -------------------------------------------------------------------------- | |
8 | #ifdef __GNUG__ | |
9 | #pragma implementation "sndg72x.cpp" | |
10 | #endif | |
11 | ||
92a19c2e | 12 | #include "wx/wxprec.h" |
e8482f24 GL |
13 | |
14 | #ifndef WX_PRECOMP | |
15 | #include "wx/defs.h" | |
16 | #endif | |
17 | ||
18 | #include "wx/mmedia/sndbase.h" | |
19 | #include "wx/mmedia/sndfile.h" | |
20 | #include "wx/mmedia/sndpcm.h" | |
21 | #include "wx/mmedia/sndg72x.h" | |
22 | #include "wx/mmedia/internal/g72x.h" | |
23 | ||
24 | // -------------------------------------------------------------------------- | |
25 | // wxSoundFormatG72X | |
26 | // -------------------------------------------------------------------------- | |
27 | ||
28 | wxSoundFormatG72X::wxSoundFormatG72X() | |
29 | : m_srate(22050) | |
30 | { | |
31 | } | |
32 | ||
33 | wxSoundFormatG72X::~wxSoundFormatG72X() | |
34 | { | |
35 | } | |
36 | ||
37 | void wxSoundFormatG72X::SetSampleRate(wxUint32 srate) | |
38 | { | |
39 | m_srate = srate; | |
40 | } | |
41 | ||
42 | wxUint32 wxSoundFormatG72X::GetSampleRate() const | |
43 | { | |
44 | return m_srate; | |
45 | } | |
46 | ||
47 | void wxSoundFormatG72X::SetG72XType(wxSoundG72XType type) | |
48 | { | |
49 | m_g72x_type = type; | |
50 | } | |
51 | ||
52 | wxSoundFormatBase *wxSoundFormatG72X::Clone() const | |
53 | { | |
54 | wxSoundFormatG72X *g72x = new wxSoundFormatG72X(); | |
55 | ||
56 | g72x->m_srate = m_srate; | |
57 | g72x->m_g72x_type = m_g72x_type; | |
58 | return g72x; | |
59 | } | |
60 | ||
61 | wxUint32 wxSoundFormatG72X::GetTimeFromBytes(wxUint32 bytes) const | |
62 | { | |
63 | int n_bits; | |
64 | ||
65 | switch (m_g72x_type) { | |
66 | case wxSOUND_G721: | |
67 | n_bits = 4; | |
68 | break; | |
69 | case wxSOUND_G723_24: | |
70 | n_bits = 3; | |
71 | break; | |
72 | case wxSOUND_G723_40: | |
73 | n_bits = 5; | |
74 | break; | |
75 | default: | |
76 | n_bits = 0; | |
77 | break; | |
78 | } | |
79 | return (wxUint32)((bytes / m_srate) * n_bits) / 8; | |
80 | } | |
81 | ||
82 | wxUint32 wxSoundFormatG72X::GetBytesFromTime(wxUint32 time) const | |
83 | { | |
84 | int n_bits; | |
85 | ||
86 | switch (m_g72x_type) { | |
87 | case wxSOUND_G721: | |
88 | n_bits = 4; | |
89 | break; | |
90 | case wxSOUND_G723_24: | |
91 | n_bits = 3; | |
92 | break; | |
93 | case wxSOUND_G723_40: | |
94 | n_bits = 5; | |
95 | break; | |
96 | default: | |
97 | n_bits = 0; | |
98 | } | |
99 | return (wxUint32)((time * m_srate * n_bits) / 8); | |
100 | } | |
101 | ||
102 | bool wxSoundFormatG72X::operator !=(const wxSoundFormatBase& frmt2) const | |
103 | { | |
104 | wxSoundFormatG72X *g72x = (wxSoundFormatG72X *)&frmt2; | |
105 | ||
106 | if (frmt2.GetType() != wxSOUND_G72X) | |
107 | return TRUE; | |
108 | ||
109 | return (g72x->m_srate != m_srate || g72x->m_g72x_type != m_g72x_type); | |
110 | } | |
111 | ||
112 | // -------------------------------------------------------------------------- | |
113 | // wxSoundStreamG72X | |
114 | // -------------------------------------------------------------------------- | |
115 | ||
116 | wxSoundStreamG72X::wxSoundStreamG72X(wxSoundStream& sndio) | |
117 | : wxSoundStreamCodec(sndio) | |
118 | { | |
119 | // PCM converter | |
120 | m_router = new wxSoundRouterStream(sndio); | |
121 | m_state = new g72state; | |
122 | g72x_init_state(m_state); | |
123 | } | |
124 | ||
125 | wxSoundStreamG72X::~wxSoundStreamG72X() | |
126 | { | |
127 | delete m_router; | |
128 | } | |
129 | ||
130 | wxSoundStream& wxSoundStreamG72X::Read(void *buffer, wxUint32 len) | |
131 | { | |
132 | wxUint16 *old_linear; | |
133 | register wxUint16 *linear_buffer; | |
134 | register wxUint32 real_len; | |
135 | register wxUint32 countdown = len; | |
136 | ||
137 | real_len = (len * 8 / m_n_bits); | |
138 | ||
139 | old_linear = linear_buffer = new wxUint16[real_len]; | |
140 | ||
141 | m_router->Read(linear_buffer, real_len); | |
142 | ||
143 | real_len = (wxUint32)(m_router->GetLastAccess() * ((float)m_n_bits / 8)); | |
144 | if (!real_len) | |
145 | return *m_router; | |
146 | ||
147 | m_io_buffer = (wxUint8 *)buffer; | |
148 | m_current_b_pos = 0; | |
149 | ||
150 | while (countdown != 0) { | |
151 | PutBits(m_coder(*linear_buffer++, AUDIO_ENCODING_LINEAR, m_state)); | |
152 | countdown--; | |
153 | } | |
154 | m_lastcount = real_len; | |
155 | m_snderror = m_router->GetError(); | |
156 | ||
157 | delete[] old_linear; | |
158 | ||
159 | return *this; | |
160 | } | |
161 | ||
162 | wxSoundStream& wxSoundStreamG72X::Write(const void *buffer, wxUint32 len) | |
163 | { | |
164 | wxUint16 *old_linear; | |
165 | register wxUint16 *linear_buffer; | |
166 | register wxUint32 countdown = len; | |
167 | register wxUint32 real_len; | |
168 | ||
169 | // Compute the real length (PCM format) to sendt to the sound card | |
170 | real_len = (len * m_n_bits / 8); | |
171 | ||
172 | // Allocate a temporary buffer | |
173 | old_linear = linear_buffer = new wxUint16[real_len]; | |
174 | ||
175 | // Bad, we override the const | |
176 | m_io_buffer = (wxUint8 *)buffer; | |
177 | m_current_b_pos = 0; | |
178 | ||
179 | // Decode the datas | |
180 | while (countdown != 0) { | |
181 | *linear_buffer++ = m_decoder(GetBits(), AUDIO_ENCODING_LINEAR, m_state); | |
182 | countdown--; | |
183 | } | |
184 | m_lastcount = len; | |
185 | ||
186 | // Send them to the sound card | |
187 | m_router->Write(old_linear, real_len); | |
188 | ||
189 | // Destroy the temporary buffer | |
190 | delete[] old_linear; | |
191 | ||
192 | return *m_router; | |
193 | } | |
194 | ||
195 | bool wxSoundStreamG72X::SetSoundFormat(const wxSoundFormatBase& format) | |
196 | { | |
197 | if (format.GetType() != wxSOUND_G72X) { | |
198 | m_snderror = wxSOUND_INVFRMT; | |
199 | return FALSE; | |
200 | } | |
201 | ||
202 | wxSoundFormatPcm pcm; | |
203 | wxSoundFormatG72X *g72x; | |
204 | ||
205 | wxSoundStreamCodec::SetSoundFormat(format); | |
206 | ||
207 | g72x = (wxSoundFormatG72X *)m_sndformat; | |
208 | ||
209 | // Set PCM as the output format of the codec | |
210 | pcm.SetSampleRate(g72x->GetSampleRate()); | |
211 | pcm.SetBPS(16); | |
212 | pcm.SetChannels(1); // Only mono supported | |
213 | pcm.Signed(TRUE); | |
214 | pcm.SetOrder(wxBYTE_ORDER); | |
215 | ||
216 | // Look for the correct codec to use and set its bit width | |
217 | switch (g72x->GetG72XType()) { | |
218 | case wxSOUND_G721: | |
219 | m_n_bits = 4; | |
220 | m_coder = g721_encoder; | |
221 | m_decoder = g721_decoder; | |
222 | break; | |
223 | case wxSOUND_G723_24: | |
224 | m_n_bits = 3; | |
225 | m_coder = g723_24_encoder; | |
226 | m_decoder = g723_24_decoder; | |
227 | break; | |
228 | case wxSOUND_G723_40: | |
229 | m_n_bits = 5; | |
230 | m_coder = g723_40_encoder; | |
231 | m_decoder = g723_40_decoder; | |
232 | break; | |
233 | } | |
234 | ||
235 | // Let the router finish the work | |
236 | m_router->SetSoundFormat(pcm); | |
237 | ||
238 | return TRUE; | |
239 | } | |
240 | ||
241 | #define BYTE_SIZE 8 | |
242 | ||
243 | wxUint8 wxSoundStreamG72X::GetBits() | |
244 | { | |
245 | register wxUint8 bits; | |
246 | ||
247 | // We have two bytes to compute | |
248 | if (m_current_b_pos < m_n_bits) { | |
249 | register wxUint8 b_left; | |
250 | ||
251 | // TRANSLATE the mask | |
252 | m_current_mask >>= m_current_b_pos; | |
253 | ||
254 | // GET the last bits: 0001..1 | |
255 | bits = (m_current_byte & m_current_mask) << (m_n_bits - m_current_b_pos); | |
256 | ||
257 | // GEN: 1. n times .1000 | |
258 | b_left = BYTE_SIZE-m_n_bits; | |
259 | m_current_mask = ((1 << m_n_bits) - 1) << b_left; | |
260 | ||
261 | // GET the next byte | |
262 | m_current_byte = *m_io_buffer++; | |
263 | ||
264 | register wxUint8 tmp_mask; | |
265 | ||
266 | // COMPUTE a new temporary mask to get the last bits | |
267 | b_left = m_n_bits - b_left; | |
268 | tmp_mask = (1 << b_left) - 1; | |
269 | // TRANSLATE the old mask to get ready for the next time | |
270 | m_current_mask >>= b_left; | |
271 | ||
272 | // COMPUTE the new bit position | |
273 | b_left = BYTE_SIZE - b_left; | |
274 | m_current_b_pos = b_left; | |
275 | tmp_mask <<= b_left; | |
276 | ||
277 | // GET the last bits | |
278 | bits |= (m_current_byte & tmp_mask) >> b_left; | |
279 | } else { | |
280 | m_current_mask >>= m_n_bits; | |
281 | m_current_b_pos -= m_n_bits; | |
282 | bits = (m_current_byte & m_current_mask) >> m_current_b_pos; | |
283 | } | |
284 | return bits; | |
285 | } | |
286 | ||
287 | void wxSoundStreamG72X::PutBits(wxUint8 bits) | |
288 | { | |
289 | if (m_current_b_pos < m_n_bits) { | |
290 | register wxUint8 tmp_mask; | |
291 | register wxUint8 diff; | |
292 | ||
293 | diff = m_n_bits - m_current_b_pos; | |
294 | // Pack bits and put the byte in the buffer | |
295 | m_current_byte |= bits >> diff; | |
296 | *m_io_buffer++ = m_current_byte; | |
297 | ||
298 | // Gen a mask | |
299 | tmp_mask = ~((1 << diff) - 1); | |
300 | ||
301 | m_current_b_pos = BYTE_SIZE - (m_n_bits - m_current_b_pos); | |
302 | ||
303 | m_current_byte = (bits & (tmp_mask)) << m_current_b_pos; | |
304 | } else { | |
305 | m_current_b_pos -= m_n_bits; | |
306 | bits <<= m_current_b_pos; | |
307 | m_current_byte |= bits; | |
308 | } | |
309 | } |