3 Copyright (C) 2011 Belledonne Communications SARL
4 Author: Simon MORLAT (simon.morlat@linphone.org)
6 This program is free software; you can redistribute it and/or
7 modify it under the terms of the GNU General Public License
8 as published by the Free Software Foundation; either version 2
9 of the License, or (at your option) any later version.
11 This program is distributed in the hope that it will be useful,
12 but WITHOUT ANY WARRANTY; without even the implied warranty of
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 GNU General Public License for more details.
16 You should have received a copy of the GNU General Public License
17 along with this program; if not, write to the Free Software
18 Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
23 #include "mediastreamer2/mstonedetector.h"
24 #include "mediastreamer2/dtmfgen.h"
30 static void ecc_init_filters(EcCalibrator *ecc){
31 ecc->ticker=ms_ticker_new();
33 ecc->sndread=ms_snd_card_create_reader(ecc->play_card);
34 ecc->det=ms_filter_new(MS_TONE_DETECTOR_ID);
35 ecc->rec=ms_filter_new(MS_FILE_REC_ID);
37 ms_filter_link(ecc->sndread,0,ecc->det,0);
38 ms_filter_link(ecc->det,0,ecc->rec,0);
40 ecc->play=ms_filter_new(MS_FILE_PLAYER_ID);
41 ecc->gen=ms_filter_new(MS_DTMF_GEN_ID);
42 ecc->resampler=ms_filter_new(MS_RESAMPLE_ID);
43 ecc->sndwrite=ms_snd_card_create_writer(ecc->capt_card);
45 ms_filter_link(ecc->play,0,ecc->gen,0);
46 ms_filter_link(ecc->gen,0,ecc->resampler,0);
47 ms_filter_link(ecc->resampler,0,ecc->sndwrite,0);
49 ms_filter_call_method(ecc->sndwrite,MS_FILTER_GET_SAMPLE_RATE,&rate);
50 ms_filter_call_method(ecc->resampler,MS_FILTER_SET_OUTPUT_SAMPLE_RATE,&rate);
52 ms_ticker_attach(ecc->ticker,ecc->play);
53 ms_ticker_attach(ecc->ticker,ecc->sndread);
56 static void ecc_deinit_filters(EcCalibrator *ecc){
57 ms_ticker_detach(ecc->ticker,ecc->play);
58 ms_ticker_detach(ecc->ticker,ecc->sndread);
60 ms_filter_unlink(ecc->play,0,ecc->gen,0);
61 ms_filter_unlink(ecc->gen,0,ecc->resampler,0);
62 ms_filter_unlink(ecc->resampler,0,ecc->sndwrite,0);
64 ms_filter_unlink(ecc->sndread,0,ecc->det,0);
65 ms_filter_unlink(ecc->det,0,ecc->rec,0);
67 ms_filter_destroy(ecc->sndread);
68 ms_filter_destroy(ecc->det);
69 ms_filter_destroy(ecc->rec);
70 ms_filter_destroy(ecc->play);
71 ms_filter_destroy(ecc->gen);
72 ms_filter_destroy(ecc->resampler);
73 ms_filter_destroy(ecc->sndwrite);
75 ms_ticker_destroy(ecc->ticker);
78 static void on_tone_sent(void *data, MSFilter *f, unsigned int event_id, void *arg){
79 MSDtmfGenEvent *ev=(MSDtmfGenEvent*)arg;
80 EcCalibrator *ecc=(EcCalibrator*)data;
82 ecc->acc-=ev->tone_start_time;
83 ms_message("Sent tone at %u",(unsigned int)ev->tone_start_time);
86 static void on_tone_received(void *data, MSFilter *f, unsigned int event_id, void *arg){
87 MSToneDetectorEvent *ev=(MSToneDetectorEvent*)arg;
88 EcCalibrator *ecc=(EcCalibrator*)data;
90 ecc->acc+=ev->tone_start_time;
91 ms_message("Received tone at %u",(unsigned int)ev->tone_start_time);
94 static void ecc_play_tones(EcCalibrator *ecc){
95 MSDtmfGenCustomTone tone;
96 MSToneDetectorDef expected_tone;
99 ms_filter_set_notify_callback(ecc->det,on_tone_received,ecc);
101 expected_tone.frequency=2000;
102 expected_tone.min_duration=40;
103 expected_tone.min_amplitude=0.02;
105 ms_filter_call_method (ecc->det,MS_TONE_DETECTOR_ADD_SCAN,&expected_tone);
111 /*play an initial tone to startup the audio playback/capture*/
112 ms_filter_call_method(ecc->gen,MS_DTMF_GEN_PLAY_CUSTOM,&tone);
115 ms_filter_set_notify_callback(ecc->gen,on_tone_sent,ecc);
119 ms_filter_call_method(ecc->gen,MS_DTMF_GEN_PLAY_CUSTOM,&tone);
121 ms_filter_call_method(ecc->gen,MS_DTMF_GEN_PLAY_CUSTOM,&tone);
123 ms_filter_call_method(ecc->gen,MS_DTMF_GEN_PLAY_CUSTOM,&tone);
126 if (ecc->sent_count==3 && ecc->recv_count==3){
127 int delay=ecc->acc/3;
129 ms_error("Quite surprising calibration result, delay=%i",delay);
130 ecc->status=LinphoneEcCalibratorFailed;
131 }else{ms_message("Echo calibration estimated delay to be %i ms",delay);
133 ecc->status=LinphoneEcCalibratorDone;
136 ms_error("Echo calibration failed, tones received = %i",ecc->recv_count);
137 ecc->status=LinphoneEcCalibratorFailed;
142 static void * ecc_thread(void *p){
143 EcCalibrator *ecc=(EcCalibrator*)p;
145 ecc_init_filters(ecc);
147 ecc_deinit_filters(ecc);
148 ms_thread_exit(NULL);
152 EcCalibrator * ec_calibrator_new(MSSndCard *play_card, MSSndCard *capt_card, LinphoneEcCalibrationCallback cb, void *cb_data ){
153 EcCalibrator *ecc=ms_new0(EcCalibrator,1);
156 ecc->cb_data=cb_data;
157 ecc->capt_card=capt_card;
158 ecc->play_card=play_card;
159 ms_thread_create(&ecc->thread,NULL,ecc_thread,ecc);
163 LinphoneEcCalibratorStatus ec_calibrator_get_status(EcCalibrator *ecc){
167 void ec_calibrator_destroy(EcCalibrator *ecc){
168 ms_thread_join(ecc->thread,NULL);
172 int linphone_core_start_echo_calibration(LinphoneCore *lc, LinphoneEcCalibrationCallback cb, void *cb_data){
174 ms_error("Echo calibration is still on going !");
177 lc->ecc=ec_calibrator_new(lc->sound_conf.play_sndcard,lc->sound_conf.capt_sndcard,cb,cb_data);