diff --git a/src/audio/tdfb/tdfb_direction.c b/src/audio/tdfb/tdfb_direction.c index 49ad5fdfe..a3282b5cc 100644 --- a/src/audio/tdfb/tdfb_direction.c +++ b/src/audio/tdfb/tdfb_direction.c @@ -403,8 +403,11 @@ static void theoretical_time_differences(struct tdfb_comp_data *cd, int16_t az) for (i = 0; i < n_mic - 1; i++) { delta_d = d[i + 1] - d[0]; /* Meters Q4.12 */ + /* Multiply delta_d (Q4.12) by RECIPROCAL_SPEED_OF_SOUND_Q31 (Q1.31) and + * right-shift the result by 12 bits to preserve the Q1.31 format. + */ cd->direction.timediff_iter[i] = - (int32_t)((((int64_t)delta_d) << 19) / SPEED_OF_SOUND); + Q_MULTS_32X32((int64_t)delta_d, RECIPROCAL_SPEED_OF_SOUND_Q31, 12, 31, 31); } } diff --git a/src/include/sof/math/numbers.h b/src/include/sof/math/numbers.h index 1fd61f632..0cd9314f4 100644 --- a/src/include/sof/math/numbers.h +++ b/src/include/sof/math/numbers.h @@ -117,5 +117,6 @@ uint32_t crc32(uint32_t base, const void *data, uint32_t bytes); /* Speed of sound (m/s) in 20 C temperature at standard atmospheric pressure */ #define SPEED_OF_SOUND 343 +#define RECIPROCAL_SPEED_OF_SOUND_Q31 6260885 /* Q1.31 */ #endif /* __SOF_MATH_NUMBERS_H__ */