localisation_audio/Localisation_360/test.cpp

117 lines
4.1 KiB
C++
Raw Normal View History

void TraitementSonsSuivants() {
SAMPLE_TYPE* bufs[3];
bufs[0] = _TamponDroit;
bufs[1] = _TamponGauche;
bufs[2] = _TamponAvant;
int err;
if ((err = snd_pcm_readn(_capture_handle, (void**) bufs, _TailleTampon))!= _TailleTampon) {
fprintf(stderr, "Echec de la lecture de l'interface audio (%s)\n",snd_strerror(err));
exit(1);
}
// compute the sound level (i.e. "loudness" of the sound):
SAMPLE_TYPE Niveau = CalculNiv(_TamponDroit, _TamponGauche, _TamponAvant);
// update the average sound level with this new measure:
_MoyNivSonore->nvelleValeur(Niveau);
// relative sound level of this sample compared to average:
float NivRelatif = (float) Niveau / (float) _MoyNivSonore->getMean();
//cout << "level " << level << ", relative " << NivRelatif << endl;
int minDiff = INT_MAX;
int minDiff2 = INT_MAX;
int minDiff3 = INT_MAX;
int minDiffTime = -1;
int minDiffTime2 = -1;
int minDiffTime3 = -1;
// glisse sur l'axe du temps pour trouver la différence sonore minimum entre les microphones Droit et Gauche
for (int t = -_nbEchantillonsDiffMax; t < _nbEchantillonsDiffMax; t++) {
// calcule la somme des différences pour simuler une mesure de corrélation croisée:
int diff = 0;
for (int i = _nbEchantillonsDiffMax; i < _TailleTampon - _nbEchantillonsDiffMax - 1; i++) {
diff += abs(_TamponGauche[i] - _TamponDroit[i + t]);
}
if (diff < minDiff) {
minDiff = diff;
minDiffTime = t;
}
}
for (int t2 = -_nbEchantillonsDiffMax; t2 < _nbEchantillonsDiffMax; t2++) {
int diff2 = 0;
for (int i = _nbEchantillonsDiffMax; i < _TailleTampon - _nbEchantillonsDiffMax - 1; i++) {
diff2 += abs(_TamponGauche[i] - _TamponAvant[i + t2]);
}
if (diff2 < minDiff2) {
minDiff2 = diff2;
minDiffTime2 = t2;
}
}
for (int t3 = -_nbEchantillonsDiffMax; t3 < _nbEchantillonsDiffMax; t3++) {
int diff3 = 0;
for (int i = _nbEchantillonsDiffMax; i < _TailleTampon - _nbEchantillonsDiffMax - 1; i++) {
diff3 += abs(_TamponAvant[i] - _TamponDroit[i + t3]);
}
if (diff3 < minDiff3) {
minDiff3 = diff3;
minDiffTime3 = t3;
}
}
if (t<t2 && t<t3) {
// Si le son est assez fort et pas extrême (= ce qui entraine généralement de fausses
// mesures), alors on le dessine:
if ((NivRelatif > _NiveauSonMin) && (minDiffTime > -_nbEchantillonsDiffMax) && (minDiffTime < _nbEchantillonsDiffMax)) {
// computation of angle depending on diff time, sampling rates,
// and geometry
float angle = -(float) asin((minDiffTime * _Vson) / (_TauxEchantillonnageSon* _DistanceMic));
cout << angle << ";" << NivRelatif << endl;
}
}
if (t2<t && t2<t3) {
// Si le son est assez fort et pas extrême (= ce qui entraine généralement de fausses
// mesures), alors on le dessine:
if ((NivRelatif > _NiveauSonMin) && (minDiffTime2 > -_nbEchantillonsDiffMax) && (minDiffTime2 < _nbEchantillonsDiffMax)) {
// computation of angle depending on diff time, sampling rates,
// and geometry
float angle = -(float) asin((minDiffTime2 * _Vson) / (_TauxEchantillonnageSon* _DistanceMic));
cout << angle << ";" << NivRelatif << endl;
}
}
if (t3<t && t3<t2) {
// Si le son est assez fort et pas extrême (= ce qui entraine généralement de fausses
// mesures), alors on le dessine:
if ((NivRelatif > _NiveauSonMin) && (minDiffTime3 > -_nbEchantillonsDiffMax) && (minDiffTime3 < _nbEchantillonsDiffMax)) {
// computation of angle depending on diff time, sampling rates,
// and geometry
float angle = -(float) asin((minDiffTime3 * _Vson) / (_TauxEchantillonnageSon* _DistanceMic));
cout << angle << ";" << NivRelatif << endl;
}
}
}
/**
* Calcule du niveau sonore moyen (la puissance) pour les canaux gauche et droit.
*/
SAMPLE_TYPE CalculNiv(SAMPLE_TYPE Droit[], SAMPLE_TYPE Gauche[], SAMPLE_TYPE Avant[]) {
float Niveau = 0;
for (int i = 0; i < _TailleTampon; i++) {
float s = (Gauche[i] + Droit[i]+ Avant[i]) / 3;
Niveau += (s * s);
}
Niveau /= _TailleTampon;
Niveau = sqrt(Niveau);
return (SAMPLE_TYPE) Niveau;
}
};