| /****************************************************************************** |
| * |
| * Copyright (C) 2018 The Android Open Source Project |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at: |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| * |
| ***************************************************************************** |
| * Originally developed and contributed by Ittiam Systems Pvt. Ltd, Bangalore |
| */ |
| #include <math.h> |
| #include <string.h> |
| #include "impd_type_def.h" |
| #include "impd_error_standards.h" |
| #include "impd_memory_standards.h" |
| #include "impd_drc_peak_limiter.h" |
| #include "impd_drc_extr_delta_coded_info.h" |
| #include "impd_drc_common.h" |
| #include "impd_drc_struct.h" |
| #include "impd_drc_interface.h" |
| #include "impd_drc_bitbuffer.h" |
| #include "impd_drc_bitstream_dec_api.h" |
| #include "impd_drc_gain_dec.h" |
| #include "impd_drc_filter_bank.h" |
| #include "impd_drc_multi_band.h" |
| #include "impd_drc_process_audio.h" |
| #include "impd_parametric_drc_dec.h" |
| #include "impd_drc_eq.h" |
| #include "impd_drc_gain_decoder.h" |
| #include "impd_drc_selection_process.h" |
| #include "impd_drc_api_struct_def.h" |
| #include "impd_drc_hashdefines.h" |
| #include "impd_drc_peak_limiter.h" |
| |
| static IA_ERRORCODE impd_down_mix( |
| ia_drc_sel_proc_output_struct *uni_drc_sel_proc_output, |
| FLOAT32 **input_audio, WORD32 frame_len) { |
| WORD32 num_base_ch = uni_drc_sel_proc_output->base_channel_count; |
| WORD32 num_target_ch = uni_drc_sel_proc_output->target_channel_count; |
| WORD32 i, i_ch, o_ch; |
| FLOAT32 tmp_out[MAX_CHANNEL_COUNT]; |
| |
| if (num_target_ch > MAX_CHANNEL_COUNT) return -1; |
| |
| if (num_target_ch > num_base_ch) return -1; |
| |
| for (i = 0; i < frame_len; i++) { |
| for (o_ch = 0; o_ch < num_target_ch; o_ch++) { |
| tmp_out[o_ch] = 0.0f; |
| for (i_ch = 0; i_ch < num_base_ch; i_ch++) { |
| tmp_out[o_ch] += input_audio[i_ch][i] * |
| uni_drc_sel_proc_output->downmix_matrix[i_ch][o_ch]; |
| } |
| } |
| for (o_ch = 0; o_ch < num_target_ch; o_ch++) { |
| input_audio[o_ch][i] = tmp_out[o_ch]; |
| } |
| for (; o_ch < num_base_ch; o_ch++) { |
| input_audio[o_ch][i] = 0.0f; |
| } |
| } |
| |
| return IA_NO_ERROR; |
| } |
| |
| IA_ERRORCODE impd_process_time_domain(ia_drc_api_struct *p_obj_drc) { |
| IA_ERRORCODE err_code = IA_NO_ERROR; |
| WORD32 i, j; |
| FLOAT32 *audio_buff[10]; |
| WORD32 last_frame = 0; |
| WORD32 num_sample_to_process; |
| |
| if (p_obj_drc->p_state->ui_in_bytes <= 0) { |
| p_obj_drc->p_state->ui_out_bytes = 0; |
| return IA_NO_ERROR; |
| } |
| |
| err_code = impd_process_drc_bitstream_dec_gain( |
| p_obj_drc->str_payload.pstr_bitstream_dec, p_obj_drc->pstr_bit_buf, |
| p_obj_drc->str_payload.pstr_drc_config, |
| p_obj_drc->str_payload.pstr_drc_gain, |
| &p_obj_drc->str_bit_handler |
| .it_bit_buf[p_obj_drc->str_bit_handler.byte_index_bs], |
| p_obj_drc->str_bit_handler.num_bytes_bs, |
| p_obj_drc->str_bit_handler.num_bits_offset_bs, |
| &p_obj_drc->str_bit_handler.num_bits_read_bs); |
| |
| if (err_code > PROC_COMPLETE) return -1; |
| |
| p_obj_drc->str_bit_handler.num_bytes_read_bs = |
| (p_obj_drc->str_bit_handler.num_bits_read_bs >> 3); |
| p_obj_drc->str_bit_handler.num_bits_offset_bs = |
| (p_obj_drc->str_bit_handler.num_bits_read_bs & 7); |
| p_obj_drc->str_bit_handler.byte_index_bs += |
| p_obj_drc->str_bit_handler.num_bytes_read_bs; |
| |
| if (p_obj_drc->str_bit_handler.num_bits_offset_bs != 0) { |
| p_obj_drc->str_bit_handler.num_bits_read_bs = |
| p_obj_drc->str_bit_handler.num_bits_read_bs + 8 - |
| p_obj_drc->str_bit_handler.num_bits_offset_bs; |
| p_obj_drc->str_bit_handler.num_bytes_read_bs = |
| p_obj_drc->str_bit_handler.num_bytes_read_bs + 1; |
| p_obj_drc->str_bit_handler.num_bits_offset_bs = 0; |
| p_obj_drc->str_bit_handler.byte_index_bs = |
| p_obj_drc->str_bit_handler.byte_index_bs + 1; |
| } |
| |
| num_sample_to_process = |
| (p_obj_drc->p_state->ui_in_bytes / p_obj_drc->str_config.num_ch_in / |
| (p_obj_drc->str_config.pcm_size >> 3)); |
| |
| p_obj_drc->str_config.frame_size = num_sample_to_process; |
| |
| if (num_sample_to_process < p_obj_drc->str_config.frame_size) last_frame = 1; |
| |
| if (p_obj_drc->str_config.pcm_size == 16) { |
| FLOAT32 *scratch_buffer = (FLOAT32 *)p_obj_drc->pp_mem[1]; |
| WORD16 *input_buffer16 = (WORD16 *)p_obj_drc->pp_mem[2]; |
| for (i = 0; i < p_obj_drc->str_config.num_ch_in; i++) { |
| audio_buff[i] = |
| scratch_buffer + i * (p_obj_drc->str_config.frame_size + 32); |
| |
| for (j = 0; j < num_sample_to_process; j++) { |
| audio_buff[i][j] = |
| ((FLOAT32)input_buffer16[j * p_obj_drc->str_config.num_ch_in + i]) / |
| 32767.0f; |
| } |
| } |
| } else if (p_obj_drc->str_config.pcm_size == 24) { |
| FLOAT32 *scratch_buffer = (FLOAT32 *)p_obj_drc->pp_mem[1]; |
| WORD8 *input_buffer8 = (WORD8 *)p_obj_drc->pp_mem[2]; |
| for (i = 0; i < p_obj_drc->str_config.num_ch_in; i++) { |
| audio_buff[i] = |
| scratch_buffer + i * (p_obj_drc->str_config.frame_size + 32); |
| |
| for (j = 0; j < num_sample_to_process; j++) { |
| WORD32 temp; |
| |
| WORD8 *addr = |
| (WORD8 *)(&input_buffer8[3 * j * p_obj_drc->str_config.num_ch_in + |
| 3 * i]); |
| temp = (WORD8)(*(addr + 2)); |
| temp = (temp << 8) | ((WORD8)(*(addr + 1)) & 0xff); |
| temp = (temp << 8) | (((WORD8) * (addr)) & 0xff); |
| |
| audio_buff[i][j] = (FLOAT32)((temp) / 8388607.0f); |
| } |
| } |
| } else { |
| FLOAT32 *scratch_buffer = (FLOAT32 *)p_obj_drc->pp_mem[1]; |
| FLOAT32 *input_buffer = (FLOAT32 *)p_obj_drc->pp_mem[2]; |
| for (i = 0; i < p_obj_drc->str_config.num_ch_in; i++) { |
| audio_buff[i] = |
| scratch_buffer + i * (p_obj_drc->str_config.frame_size + 32); |
| |
| for (j = 0; j < num_sample_to_process; j++) { |
| audio_buff[i][j] = |
| input_buffer[j * p_obj_drc->str_config.num_ch_in + i]; |
| } |
| } |
| } |
| |
| err_code = impd_drc_process_time_domain( |
| p_obj_drc->str_payload.pstr_gain_dec[0], |
| p_obj_drc->str_payload.pstr_drc_config, |
| p_obj_drc->str_payload.pstr_drc_gain, audio_buff, |
| p_obj_drc->str_payload.pstr_drc_sel_proc_output |
| ->loudness_normalization_gain_db, |
| p_obj_drc->str_payload.pstr_drc_sel_proc_output->boost, |
| p_obj_drc->str_payload.pstr_drc_sel_proc_output->compress, |
| p_obj_drc->str_payload.pstr_drc_sel_proc_output |
| ->drc_characteristic_target); |
| |
| if (err_code != IA_NO_ERROR) return err_code; |
| |
| if (p_obj_drc->str_payload.pstr_drc_sel_proc_output->downmix_matrix_present != |
| 0) |
| err_code = impd_down_mix(p_obj_drc->str_payload.pstr_drc_sel_proc_output, |
| audio_buff, p_obj_drc->str_config.frame_size); |
| |
| if (err_code != IA_NO_ERROR) return err_code; |
| |
| err_code = impd_drc_process_time_domain( |
| p_obj_drc->str_payload.pstr_gain_dec[1], |
| p_obj_drc->str_payload.pstr_drc_config, |
| p_obj_drc->str_payload.pstr_drc_gain, audio_buff, |
| p_obj_drc->str_payload.pstr_drc_sel_proc_output |
| ->loudness_normalization_gain_db, |
| p_obj_drc->str_payload.pstr_drc_sel_proc_output->boost, |
| p_obj_drc->str_payload.pstr_drc_sel_proc_output->compress, |
| p_obj_drc->str_payload.pstr_drc_sel_proc_output |
| ->drc_characteristic_target); |
| |
| if (err_code != IA_NO_ERROR) return err_code; |
| |
| if (p_obj_drc->str_payload.pstr_drc_sel_proc_output |
| ->loudness_normalization_gain_db != 0.0f) { |
| FLOAT32 gain_value = |
| (FLOAT32)pow(10.0, p_obj_drc->str_payload.pstr_drc_sel_proc_output |
| ->loudness_normalization_gain_db / |
| 20.0); |
| for (i = 0; i < p_obj_drc->str_config.num_ch_out; i++) { |
| for (j = 0; j < p_obj_drc->str_config.frame_size; j++) { |
| audio_buff[i][j] *= gain_value; |
| } |
| } |
| } |
| |
| if (p_obj_drc->str_config.peak_limiter) { |
| FLOAT32 *output_buffer = (FLOAT32 *)p_obj_drc->pp_mem[3]; |
| for (i = 0; i < p_obj_drc->str_config.num_ch_out; i++) { |
| for (j = 0; j < p_obj_drc->str_config.frame_size; j++) { |
| output_buffer[j * p_obj_drc->str_config.num_ch_out + i] = |
| audio_buff[i][j]; |
| } |
| } |
| |
| impd_limiter_process(p_obj_drc->str_payload.pstr_peak_limiter, |
| output_buffer, p_obj_drc->str_config.frame_size); |
| |
| for (i = 0; i < p_obj_drc->str_config.num_ch_out; i++) { |
| for (j = 0; j < p_obj_drc->str_config.frame_size; j++) { |
| audio_buff[i][j] = |
| output_buffer[j * p_obj_drc->str_config.num_ch_out + i]; |
| } |
| } |
| } |
| |
| if (p_obj_drc->str_config.pcm_size == 16) { |
| WORD16 *output_buffer16 = (WORD16 *)p_obj_drc->pp_mem[3]; |
| for (i = 0; i < p_obj_drc->str_config.num_ch_out; i++) { |
| for (j = 0; j < p_obj_drc->str_config.frame_size; j++) { |
| if (audio_buff[i][j] < -1.0f) |
| output_buffer16[j * p_obj_drc->str_config.num_ch_out + i] = -32767; |
| |
| else if (audio_buff[i][j] > 1.0f) |
| output_buffer16[j * p_obj_drc->str_config.num_ch_out + i] = 32767; |
| |
| else |
| output_buffer16[j * p_obj_drc->str_config.num_ch_out + i] = |
| (WORD16)(audio_buff[i][j] * 32767.0f); |
| } |
| } |
| } else if (p_obj_drc->str_config.pcm_size == 24) { |
| WORD8 *output_buffer8 = (WORD8 *)p_obj_drc->pp_mem[3]; |
| for (i = 0; i < p_obj_drc->str_config.num_ch_out; i++) { |
| for (j = 0; j < p_obj_drc->str_config.frame_size; j++) { |
| WORD32 temp = 0; |
| WORD8 *temp_addr = |
| &output_buffer8[3 * j * p_obj_drc->str_config.num_ch_out + 3 * i]; |
| |
| if (audio_buff[i][j] < -1.0f) |
| temp = -8388607; |
| |
| else if (audio_buff[i][j] > 1.0f) |
| temp = 8388607; |
| |
| else |
| temp = (WORD32)(audio_buff[i][j] * 8388607.0f); |
| |
| *temp_addr++ = (WORD8)(temp & 0xff); |
| *temp_addr++ = (WORD8)((WORD32)temp >> 8) & 0xff; |
| *temp_addr = (WORD8)((WORD32)temp >> 16) & 0xff; |
| } |
| } |
| } else { |
| FLOAT32 *output_buffer = (FLOAT32 *)p_obj_drc->pp_mem[3]; |
| for (i = 0; i < p_obj_drc->str_config.num_ch_out; i++) { |
| for (j = 0; j < p_obj_drc->str_config.frame_size; j++) { |
| output_buffer[j * p_obj_drc->str_config.num_ch_out + i] = |
| audio_buff[i][j]; |
| } |
| } |
| } |
| |
| p_obj_drc->p_state->ui_out_bytes = |
| p_obj_drc->str_config.num_ch_out * |
| (p_obj_drc->p_state->ui_in_bytes / p_obj_drc->str_config.num_ch_in); |
| |
| if (p_obj_drc->p_state->delay_in_output != 0) { |
| FLOAT32 *output_buffer = (FLOAT32 *)p_obj_drc->pp_mem[3]; |
| WORD16 *output_buffer16 = (WORD16 *)p_obj_drc->pp_mem[3]; |
| p_obj_drc->p_state->ui_out_bytes = p_obj_drc->str_config.num_ch_out * |
| (p_obj_drc->str_config.frame_size - |
| p_obj_drc->p_state->delay_in_output) * |
| (p_obj_drc->str_config.pcm_size >> 3); |
| if (p_obj_drc->str_config.pcm_size == 16) |
| memcpy(output_buffer16, |
| (output_buffer16 + (p_obj_drc->p_state->delay_in_output * |
| p_obj_drc->str_config.num_ch_out)), |
| p_obj_drc->p_state->ui_out_bytes); |
| else |
| memcpy(output_buffer, |
| (output_buffer + (p_obj_drc->p_state->delay_in_output * |
| p_obj_drc->str_config.num_ch_out)), |
| p_obj_drc->p_state->ui_out_bytes); |
| |
| p_obj_drc->p_state->delay_adjust_samples = |
| p_obj_drc->p_state->delay_in_output; |
| p_obj_drc->p_state->delay_in_output = 0; |
| } |
| if (last_frame == 1) { |
| if ((num_sample_to_process + p_obj_drc->p_state->delay_adjust_samples) <= |
| p_obj_drc->str_config.frame_size) |
| p_obj_drc->p_state->ui_out_bytes = |
| (num_sample_to_process + p_obj_drc->p_state->delay_adjust_samples) * |
| p_obj_drc->str_config.num_ch_out * |
| (p_obj_drc->str_config.pcm_size >> 3); |
| else |
| p_obj_drc->p_state->ui_out_bytes = (p_obj_drc->str_config.frame_size) * |
| p_obj_drc->str_config.num_ch_out * |
| (p_obj_drc->str_config.pcm_size >> 3); |
| } |
| return err_code; |
| } |