blob: 584d1350545e45badbb7a0152d08d84c53df3ee0 [file] [log] [blame]
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -07001/*
2 * Copyright (C) 2008 The Android Open Source Project
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
17//#define LOG_NDEBUG 0
18#define LOG_TAG "ToneGenerator"
19#include <utils/threads.h>
20
21#include <stdio.h>
22#include <math.h>
23#include <utils/Log.h>
24#include <sys/resource.h>
25#include <utils/RefBase.h>
26#include <utils/Timers.h>
27#include "media/ToneGenerator.h"
28
29namespace android {
30
31// Descriptors for all available tones (See ToneGenerator::ToneDescriptor class declaration for details)
32const ToneGenerator::ToneDescriptor
33 ToneGenerator::toneDescriptors[NUM_TONES] = {
34 // waveFreq[] segments[] repeatCnt
35 { { 1336, 941, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_0
36 { { 1209, 697, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_1
37 { { 1336, 697, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_2
38 { { 1477, 697, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_3
39 { { 1209, 770, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_4
40 { { 1336, 770, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_5
41 { { 1477, 770, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_6
42 { { 1209, 852, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_7
43 { { 1336, 852, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_8
44 { { 1477, 852, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_9
45 { { 1209, 941, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_S
46 { { 1477, 941, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_P
47 { { 1633, 697, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_A
48 { { 1633, 770, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_B
49 { { 1633, 852, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_C
50 { { 1633, 941, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_DTMF_D
51 { { 425, 0 }, { ToneGenerator::TONEGEN_INF, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_SUP_DIAL
52 { { 425, 0 }, { 500, 500, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_SUP_BUSY
53 { { 425, 0 }, { 200, 200, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_SUP_CONGESTION
54 { { 425, 0 }, { 200, 0 }, 0 }, // TONE_SUP_RADIO_ACK
55 { { 425, 0 }, { 200, 200, 0 }, 2 }, // TONE_SUP_RADIO_NOTAVAIL
56 { { 950, 1400, 1800, 0 }, { 330, 1000, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_SUP_ERROR
57 { { 425, 0 }, { 200, 600, 200, 3000, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_SUP_CALL_WAITING
58 { { 425, 0 }, { 1000, 4000, 0 }, ToneGenerator::TONEGEN_INF }, // TONE_SUP_RINGTONE
The Android Open Source Projectb7986892009-01-09 17:51:23 -080059 { { 400, 1200, 0 }, { 40, 0 }, 0 }, // TONE_PROP_BEEP
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -070060 { { 1200, 0 }, { 100, 100, 0 }, 1 }, // TONE_PROP_ACK
61 { { 300, 400, 500, 0 }, { 400, 0 }, 0 }, // TONE_PROP_NACK
62 { { 400, 1200, 0 }, { 200, 0 }, 0 }, // TONE_PROP_PROMPT
The Android Open Source Projectb7986892009-01-09 17:51:23 -080063 { { 400, 1200, 0 }, { 40, 200, 40, 0 }, 0 } // TONE_PROP_BEEP2
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -070064 };
65
66////////////////////////////////////////////////////////////////////////////////
67// ToneGenerator class Implementation
68////////////////////////////////////////////////////////////////////////////////
69
70
71//---------------------------------- public methods ----------------------------
72
73
74////////////////////////////////////////////////////////////////////////////////
75//
76// Method: ToneGenerator::ToneGenerator()
77//
78// Description: Constructor. Initializes the tone sequencer, intantiates required sine wave
79// generators, instantiates output audio track.
80//
81// Input:
82// toneType: Type of tone generated (values in enum tone_type)
83// streamType: Type of stream used for tone playback (enum AudioTrack::stream_type)
84// volume: volume applied to tone (0.0 to 1.0)
85//
86// Output:
87// none
88//
89////////////////////////////////////////////////////////////////////////////////
90ToneGenerator::ToneGenerator(int streamType, float volume) {
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -070091
92 LOGV("ToneGenerator constructor: streamType=%d, volume=%f\n", streamType, volume);
93
94 mState = TONE_IDLE;
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -080095
96 if (AudioSystem::getOutputSamplingRate(&mSamplingRate) != NO_ERROR) {
97 LOGE("Unable to marshal AudioFlinger");
98 return;
99 }
100 if (AudioSystem::getOutputFrameCount(&mBufferSize) != NO_ERROR) {
101 LOGE("Unable to marshal AudioFlinger");
102 return;
103 }
104 mStreamType = streamType;
105 mVolume = volume;
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700106 mpAudioTrack = 0;
107 mpToneDesc = 0;
108 mpNewToneDesc = 0;
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800109 // Generate tone by chunks of 20 ms to keep cadencing precision
110 mProcessSize = (mSamplingRate * 20) / 1000;
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700111
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800112 if (initAudioTrack()) {
113 LOGV("ToneGenerator INIT OK, time: %d\n", (unsigned int)(systemTime()/1000000));
114 } else {
115 LOGV("!!!ToneGenerator INIT FAILED!!!\n");
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700116 }
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700117}
118
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800119
120
121
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700122////////////////////////////////////////////////////////////////////////////////
123//
124// Method: ToneGenerator::~ToneGenerator()
125//
126// Description: Destructor. Stop sound playback and delete audio track if
127// needed and delete sine wave generators.
128//
129// Input:
130// none
131//
132// Output:
133// none
134//
135////////////////////////////////////////////////////////////////////////////////
136ToneGenerator::~ToneGenerator() {
137 LOGV("ToneGenerator destructor\n");
138
139 if (mpAudioTrack) {
140 stopTone();
141 LOGV("Delete Track: %p\n", mpAudioTrack);
142 delete mpAudioTrack;
143 }
144}
145
146////////////////////////////////////////////////////////////////////////////////
147//
148// Method: ToneGenerator::startTone()
149//
150// Description: Starts tone playback.
151//
152// Input:
153// none
154//
155// Output:
156// none
157//
158////////////////////////////////////////////////////////////////////////////////
159bool ToneGenerator::startTone(int toneType) {
160 bool lResult = false;
161
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800162 if (toneType >= NUM_TONES)
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700163 return lResult;
164
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800165 if (mState == TONE_IDLE) {
166 LOGV("startTone: try to re-init AudioTrack");
167 if (!initAudioTrack()) {
168 return lResult;
169 }
170 }
171
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700172 LOGV("startTone\n");
173
174 mLock.lock();
175
176 // Get descriptor for requested tone
177 mpNewToneDesc = &toneDescriptors[toneType];
178
179 if (mState == TONE_INIT) {
180 if (prepareWave()) {
181 LOGV("Immediate start, time %d\n", (unsigned int)(systemTime()/1000000));
182
183 mState = TONE_STARTING;
184 mLock.unlock();
185 mpAudioTrack->start();
186 mLock.lock();
187 if (mState == TONE_STARTING) {
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800188 if (mWaitCbkCond.waitRelative(mLock, seconds(1)) != NO_ERROR) {
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700189 LOGE("--- timed out");
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800190 mState = TONE_IDLE;
191 }
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700192 }
193
194 if (mState == TONE_PLAYING)
195 lResult = true;
196 }
197 } else {
198 LOGV("Delayed start\n");
199
200 mState = TONE_RESTARTING;
201 if (mWaitCbkCond.waitRelative(mLock, seconds(1)) == NO_ERROR) {
202 if (mState != TONE_INIT) {
203 lResult = true;
204 }
205 LOGV("cond received");
206 } else {
207 LOGE("--- timed out");
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800208 mState = TONE_IDLE;
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700209 }
210 }
211 mLock.unlock();
212
213 LOGV("Tone started, time %d\n", (unsigned int)(systemTime()/1000000));
214
215 return lResult;
216}
217
218////////////////////////////////////////////////////////////////////////////////
219//
220// Method: ToneGenerator::stopTone()
221//
222// Description: Stops tone playback.
223//
224// Input:
225// none
226//
227// Output:
228// none
229//
230////////////////////////////////////////////////////////////////////////////////
231void ToneGenerator::stopTone() {
232 LOGV("stopTone");
233
234 mLock.lock();
235 if (mState == TONE_PLAYING || mState == TONE_STARTING || mState == TONE_RESTARTING) {
236 mState = TONE_STOPPING;
237 LOGV("waiting cond");
238 status_t lStatus = mWaitCbkCond.waitRelative(mLock, seconds(1));
239 if (lStatus == NO_ERROR) {
240 LOGV("track stop complete, time %d", (unsigned int)(systemTime()/1000000));
241 } else {
242 LOGE("--- timed out");
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800243 mState = TONE_IDLE;
244 mpAudioTrack->stop();
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700245 }
246 }
247
248 clearWaveGens();
249
250 mLock.unlock();
251}
252
253//---------------------------------- private methods ---------------------------
254
255
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800256
257
258////////////////////////////////////////////////////////////////////////////////
259//
260// Method: ToneGenerator::initAudioTrack()
261//
262// Description: Allocates and configures AudioTrack used for PCM output.
263//
264// Input:
265// none
266//
267// Output:
268// none
269//
270////////////////////////////////////////////////////////////////////////////////
271bool ToneGenerator::initAudioTrack() {
272
273 if (mpAudioTrack) {
274 delete mpAudioTrack;
275 mpAudioTrack = 0;
276 }
277
278 // Open audio track in mono, PCM 16bit, default sampling rate, 2 buffers of
279 mpAudioTrack
280 = new AudioTrack(mStreamType, 0, AudioSystem::PCM_16_BIT, 1, NUM_PCM_BUFFERS*mBufferSize, 0, audioCallback, this, mBufferSize);
281
282 if (mpAudioTrack == 0) {
283 LOGE("AudioTrack allocation failed");
284 goto initAudioTrack_exit;
285 }
286 LOGV("Create Track: %p\n", mpAudioTrack);
287
288 if (mpAudioTrack->initCheck() != NO_ERROR) {
289 LOGE("AudioTrack->initCheck failed");
290 goto initAudioTrack_exit;
291 }
292
293 mpAudioTrack->setVolume(mVolume, mVolume);
294
295 mState = TONE_INIT;
296
297 return true;
298
299initAudioTrack_exit:
300
301 // Cleanup
302 if (mpAudioTrack) {
303 LOGV("Delete Track I: %p\n", mpAudioTrack);
304 delete mpAudioTrack;
305 mpAudioTrack = 0;
306 }
307
308 return false;
309}
310
311
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700312////////////////////////////////////////////////////////////////////////////////
313//
314// Method: ToneGenerator::audioCallback()
315//
316// Description: AudioTrack callback implementation. Generates a block of
317// PCM samples
318// and manages tone generator sequencer: tones pulses, tone duration...
319//
320// Input:
321// user reference (pointer to our ToneGenerator)
322// info audio buffer descriptor
323//
324// Output:
325// returned value: always true.
326//
327////////////////////////////////////////////////////////////////////////////////
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800328void ToneGenerator::audioCallback(int event, void* user, void *info) {
329
330 if (event != AudioTrack::EVENT_MORE_DATA) return;
331
332 const AudioTrack::Buffer *buffer = static_cast<const AudioTrack::Buffer *>(info);
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700333 ToneGenerator *lpToneGen = static_cast<ToneGenerator *>(user);
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800334 short *lpOut = buffer->i16;
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800335 unsigned int lNumSmp = buffer->size/sizeof(short);
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700336
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800337 if (buffer->size == 0) return;
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700338
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700339
340 // Clear output buffer: WaveGenerator accumulates into lpOut buffer
The Android Open Source Projectf013e1a2008-12-17 18:05:43 -0800341 memset(lpOut, 0, buffer->size);
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700342
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800343 while (lNumSmp) {
344 unsigned int lReqSmp = lNumSmp < lpToneGen->mProcessSize*2 ? lNumSmp : lpToneGen->mProcessSize;
345 unsigned int lGenSmp;
346 unsigned int lWaveCmd = WaveGenerator::WAVEGEN_CONT;
347 bool lSignal = false;
348
349 lpToneGen->mLock.lock();
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700350
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800351 // Update pcm frame count and end time (current time at the end of this process)
352 lpToneGen->mTotalSmp += lReqSmp;
353
354 // Update tone gen state machine and select wave gen command
355 switch (lpToneGen->mState) {
356 case TONE_PLAYING:
357 lWaveCmd = WaveGenerator::WAVEGEN_CONT;
358 break;
359 case TONE_STARTING:
360 LOGV("Starting Cbk");
361
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700362 lWaveCmd = WaveGenerator::WAVEGEN_START;
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800363 break;
364 case TONE_STOPPING:
365 case TONE_RESTARTING:
366 LOGV("Stop/restart Cbk");
367
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700368 lWaveCmd = WaveGenerator::WAVEGEN_STOP;
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800369 lpToneGen->mNextSegSmp = TONEGEN_INF; // forced to skip state machine management below
370 break;
371 default:
372 LOGV("Extra Cbk");
373 goto audioCallback_EndLoop;
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700374 }
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800375
376
377 // Exit if tone sequence is over
378 if (lpToneGen->mpToneDesc->segments[lpToneGen->mCurSegment] == 0) {
379 if (lpToneGen->mState == TONE_PLAYING) {
380 lpToneGen->mState = TONE_STOPPING;
381 }
382 goto audioCallback_EndLoop;
383 }
384
385 if (lpToneGen->mTotalSmp > lpToneGen->mNextSegSmp) {
386 // Time to go to next sequence segment
387
388 LOGV("End Segment, time: %d\n", (unsigned int)(systemTime()/1000000));
389
390 lGenSmp = lReqSmp;
391
392 if (lpToneGen->mCurSegment & 0x0001) {
393 // If odd segment, OFF -> ON transition : reset wave generator
394 lWaveCmd = WaveGenerator::WAVEGEN_START;
395
396 LOGV("OFF->ON, lGenSmp: %d, lReqSmp: %d\n", lGenSmp, lReqSmp);
397 } else {
398 // If even segment, ON -> OFF transition : ramp volume down
399 lWaveCmd = WaveGenerator::WAVEGEN_STOP;
400
401 LOGV("ON->OFF, lGenSmp: %d, lReqSmp: %d\n", lGenSmp, lReqSmp);
402 }
403
404 // Pre increment segment index and handle loop if last segment reached
405 if (lpToneGen->mpToneDesc->segments[++lpToneGen->mCurSegment] == 0) {
406 LOGV("Last Seg: %d\n", lpToneGen->mCurSegment);
407
408 // Pre increment loop count and restart if total count not reached. Stop sequence otherwise
409 if (++lpToneGen->mCurCount <= lpToneGen->mpToneDesc->repeatCnt) {
410 LOGV("Repeating Count: %d\n", lpToneGen->mCurCount);
411
412 lpToneGen->mCurSegment = 0;
413
414 LOGV("New segment %d, Next Time: %d\n", lpToneGen->mCurSegment,
415 (lpToneGen->mNextSegSmp*1000)/lpToneGen->mSamplingRate);
416
417 } else {
418 LOGV("End repeat, time: %d\n", (unsigned int)(systemTime()/1000000));
419
420 // Cancel OFF->ON transition in case previous segment tone state was OFF
421 if (!(lpToneGen->mCurSegment & 0x0001)) {
422 lGenSmp = 0;
423 }
424 }
425 } else {
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700426 LOGV("New segment %d, Next Time: %d\n", lpToneGen->mCurSegment,
427 (lpToneGen->mNextSegSmp*1000)/lpToneGen->mSamplingRate);
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700428 }
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800429
430 // Update next segment transition position. No harm to do it also for last segment as lpToneGen->mNextSegSmp won't be used any more
431 lpToneGen->mNextSegSmp
432 += (lpToneGen->mpToneDesc->segments[lpToneGen->mCurSegment] * lpToneGen->mSamplingRate) / 1000;
433
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700434 } else {
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800435 // Inside a segment keep tone ON or OFF
436 if (lpToneGen->mCurSegment & 0x0001) {
437 lGenSmp = 0; // If odd segment, tone is currently OFF
438 } else {
439 lGenSmp = lReqSmp; // If event segment, tone is currently ON
440 }
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700441 }
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800442
443 if (lGenSmp) {
444 // If samples must be generated, call all active wave generators and acumulate waves in lpOut
445 unsigned int lWaveIdx;
446
447 for (lWaveIdx = 0; lWaveIdx < (unsigned int)lpToneGen->mWaveGens.size(); lWaveIdx++) {
448 WaveGenerator *lpWaveGen = lpToneGen->mWaveGens[lWaveIdx];
449 lpWaveGen->getSamples(lpOut, lGenSmp, lWaveCmd);
450 }
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700451 }
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800452
453 lNumSmp -= lReqSmp;
454 lpOut += lReqSmp;
455
456audioCallback_EndLoop:
457
458 switch (lpToneGen->mState) {
459 case TONE_RESTARTING:
460 LOGV("Cbk restarting track\n");
461 if (lpToneGen->prepareWave()) {
462 lpToneGen->mState = TONE_STARTING;
463 } else {
464 lpToneGen->mState = TONE_INIT;
465 lpToneGen->mpAudioTrack->stop();
466 }
467 lSignal = true;
468 break;
469 case TONE_STOPPING:
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700470 lpToneGen->mState = TONE_INIT;
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800471 LOGV("Cbk Stopping track\n");
472 lSignal = true;
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700473 lpToneGen->mpAudioTrack->stop();
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800474
475 // Force loop exit
476 lNumSmp = 0;
477 break;
478 case TONE_STARTING:
479 LOGV("Cbk starting track\n");
480 lpToneGen->mState = TONE_PLAYING;
481 lSignal = true;
482 break;
483 default:
484 break;
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700485 }
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700486
The Android Open Source Projectb7986892009-01-09 17:51:23 -0800487 if (lSignal)
488 lpToneGen->mWaitCbkCond.signal();
489 lpToneGen->mLock.unlock();
490 }
The Android Open Source Project54b6cfa2008-10-21 07:00:00 -0700491}
492
493
494////////////////////////////////////////////////////////////////////////////////
495//
496// Method: ToneGenerator::prepareWave()
497//
498// Description: Prepare wave generators and reset tone sequencer state machine.
499// mpNewToneDesc must have been initialized befoire calling this function.
500// Input:
501// none
502//
503// Output:
504// returned value: true if wave generators have been created, false otherwise
505//
506////////////////////////////////////////////////////////////////////////////////
507bool ToneGenerator::prepareWave() {
508 unsigned int lCnt = 0;
509 unsigned int lNumWaves;
510
511 if (!mpNewToneDesc) {
512 return false;
513 }
514 // Remove existing wave generators if any
515 clearWaveGens();
516
517 mpToneDesc = mpNewToneDesc;
518
519 // Get total number of sine waves: needed to adapt sine wave gain.
520 lNumWaves = numWaves();
521
522 // Instantiate as many wave generators as listed in descriptor
523 while (lCnt < lNumWaves) {
524 ToneGenerator::WaveGenerator *lpWaveGen =
525 new ToneGenerator::WaveGenerator((unsigned short)mSamplingRate,
526 mpToneDesc->waveFreq[lCnt],
527 TONEGEN_GAIN/lNumWaves);
528 if (lpWaveGen == 0) {
529 goto prepareWave_exit;
530 }
531
532 mWaveGens.push(lpWaveGen);
533 LOGV("Create sine: %d\n", mpToneDesc->waveFreq[lCnt]);
534 lCnt++;
535 }
536
537 // Initialize tone sequencer
538 mTotalSmp = 0;
539 mCurSegment = 0;
540 mCurCount = 0;
541 mNextSegSmp = (mpToneDesc->segments[0] * mSamplingRate) / 1000;
542
543 return true;
544
545prepareWave_exit:
546
547 clearWaveGens();
548
549 return false;
550}
551
552
553////////////////////////////////////////////////////////////////////////////////
554//
555// Method: ToneGenerator::numWaves()
556//
557// Description: Count number of sine waves needed to generate tone (e.g 2 for DTMF).
558//
559// Input:
560// none
561//
562// Output:
563// returned value: nummber of sine waves
564//
565////////////////////////////////////////////////////////////////////////////////
566unsigned int ToneGenerator::numWaves() {
567 unsigned int lCnt = 0;
568
569 while (mpToneDesc->waveFreq[lCnt]) {
570 lCnt++;
571 }
572
573 return lCnt;
574}
575
576
577////////////////////////////////////////////////////////////////////////////////
578//
579// Method: ToneGenerator::clearWaveGens()
580//
581// Description: Removes all wave generators.
582//
583// Input:
584// none
585//
586// Output:
587// none
588//
589////////////////////////////////////////////////////////////////////////////////
590void ToneGenerator::clearWaveGens() {
591 LOGV("Clearing mWaveGens:");
592
593 while (!mWaveGens.isEmpty()) {
594 delete mWaveGens.top();
595 mWaveGens.pop();
596 }
597}
598
599
600////////////////////////////////////////////////////////////////////////////////
601// WaveGenerator::WaveGenerator class Implementation
602////////////////////////////////////////////////////////////////////////////////
603
604//---------------------------------- public methods ----------------------------
605
606////////////////////////////////////////////////////////////////////////////////
607//
608// Method: WaveGenerator::WaveGenerator()
609//
610// Description: Constructor.
611//
612// Input:
613// samplingRate: Output sampling rate in Hz
614// frequency: Frequency of the sine wave to generate in Hz
615// volume: volume (0.0 to 1.0)
616//
617// Output:
618// none
619//
620////////////////////////////////////////////////////////////////////////////////
621ToneGenerator::WaveGenerator::WaveGenerator(unsigned short samplingRate,
622 unsigned short frequency, float volume) {
623 double d0;
624 double F_div_Fs; // frequency / samplingRate
625
626 F_div_Fs = frequency / (double)samplingRate;
627 d0 = - (float)GEN_AMP * sin(2 * M_PI * F_div_Fs);
628 mS2_0 = (short)d0;
629 mS1 = 0;
630 mS2 = mS2_0;
631
632 mAmplitude_Q15 = (short)(32767. * 32767. * volume / GEN_AMP);
633 // take some margin for amplitude fluctuation
634 if (mAmplitude_Q15 > 32500)
635 mAmplitude_Q15 = 32500;
636
637 d0 = 32768.0 * cos(2 * M_PI * F_div_Fs); // Q14*2*cos()
638 if (d0 > 32767)
639 d0 = 32767;
640 mA1_Q14 = (short) d0;
641
642 LOGV("WaveGenerator init, mA1_Q14: %d, mS2_0: %d, mAmplitude_Q15: %d\n",
643 mA1_Q14, mS2_0, mAmplitude_Q15);
644}
645
646////////////////////////////////////////////////////////////////////////////////
647//
648// Method: WaveGenerator::~WaveGenerator()
649//
650// Description: Destructor.
651//
652// Input:
653// none
654//
655// Output:
656// none
657//
658////////////////////////////////////////////////////////////////////////////////
659ToneGenerator::WaveGenerator::~WaveGenerator() {
660}
661
662////////////////////////////////////////////////////////////////////////////////
663//
664// Method: WaveGenerator::getSamples()
665//
666// Description: Generates count samples of a sine wave and accumulates
667// result in outBuffer.
668//
669// Input:
670// outBuffer: Output buffer where to accumulate samples.
671// count: number of samples to produce.
672// command: special action requested (see enum gen_command).
673//
674// Output:
675// none
676//
677////////////////////////////////////////////////////////////////////////////////
678void ToneGenerator::WaveGenerator::getSamples(short *outBuffer,
679 unsigned int count, unsigned int command) {
680 long lS1, lS2;
681 long lA1, lAmplitude;
682 long Sample; // current sample
683
684 // init local
685 if (command == WAVEGEN_START) {
686 lS1 = (long)0;
687 lS2 = (long)mS2_0;
688 } else {
689 lS1 = (long)mS1;
690 lS2 = (long)mS2;
691 }
692 lA1 = (long)mA1_Q14;
693 lAmplitude = (long)mAmplitude_Q15;
694
695 if (command == WAVEGEN_STOP) {
696 lAmplitude <<= 16;
697 if (count == 0) {
698 return;
699 }
700 long dec = lAmplitude/count;
701 // loop generation
702 while (count--) {
703 Sample = ((lA1 * lS1) >> S_Q14) - lS2;
704 // shift delay
705 lS2 = lS1;
706 lS1 = Sample;
707 Sample = ((lAmplitude>>16) * Sample) >> S_Q15;
708 *(outBuffer++) += (short)Sample; // put result in buffer
709 lAmplitude -= dec;
710 }
711 } else {
712 // loop generation
713 while (count--) {
714 Sample = ((lA1 * lS1) >> S_Q14) - lS2;
715 // shift delay
716 lS2 = lS1;
717 lS1 = Sample;
718 Sample = (lAmplitude * Sample) >> S_Q15;
719 *(outBuffer++) += (short)Sample; // put result in buffer
720 }
721 }
722
723 // save status
724 mS1 = (short)lS1;
725 mS2 = (short)lS2;
726}
727
728} // end namespace android
729