static void write_audio( Work_buffer* out_wbs[2], const Work_buffer* gain_wb, const Work_buffer* in_wbs[2], int32_t buf_start, int32_t buf_stop) { rassert(out_wbs != NULL); rassert(gain_wb != NULL); rassert(in_wbs != NULL); rassert(buf_start >= 0); rassert(buf_stop > buf_start); const float* gains = Work_buffer_get_contents(gain_wb); for (int ch = 0; ch < 2; ++ch) { if (out_wbs[ch] == NULL || in_wbs[ch] == NULL) continue; float* out = Work_buffer_get_contents_mut(out_wbs[ch]); const float* in = Work_buffer_get_contents(in_wbs[ch]); for (int32_t i = buf_start; i < buf_stop; ++i) out[i] = in[i] * gains[i]; } return; }
const float* Work_buffers_get_buffer_contents( const Work_buffers* buffers, Work_buffer_type type) { rassert(buffers != NULL); rassert(type < WORK_BUFFER_COUNT_); return Work_buffer_get_contents(buffers->buffers[type]); }
static void apply_range( const Work_buffer* in_wb, Work_buffer* out_wb, int32_t frame_count, float mul, float add, float min_val, float max_val) { rassert(in_wb != NULL); rassert(out_wb != NULL); rassert(frame_count > 0); rassert(isfinite(mul)); rassert(isfinite(add)); rassert(min_val <= max_val); const float* in = Work_buffer_get_contents(in_wb, 0); float* out = Work_buffer_get_contents_mut(out_wb, 0); const int32_t item_count = frame_count * 2; for (int32_t i = 0; i < item_count; ++i) out[i] = (mul * in[i]) + add; if (isfinite(min_val)) { for (int32_t i = 0; i < item_count; ++i) out[i] = max(out[i], min_val); } if (isfinite(max_val)) { for (int32_t i = 0; i < item_count; ++i) out[i] = min(out[i], max_val); } return; }
static void apply_range( const Work_buffer* in_wb, Work_buffer* out_wb, int32_t buf_start, int32_t buf_stop, float mul, float add, float min_val, float max_val) { rassert(in_wb != NULL); rassert(out_wb != NULL); rassert(buf_start >= 0); rassert(buf_stop > buf_start); rassert(isfinite(mul)); rassert(isfinite(add)); rassert(min_val < max_val); const float* in = Work_buffer_get_contents(in_wb); float* out = Work_buffer_get_contents_mut(out_wb); for (int32_t i = buf_start; i < buf_stop; ++i) out[i] = (mul * in[i]) + add; if (isfinite(min_val)) { for (int32_t i = buf_start; i < buf_stop; ++i) out[i] = max(out[i], min_val); } if (isfinite(max_val)) { for (int32_t i = buf_start; i < buf_stop; ++i) out[i] = min(out[i], max_val); } return; }
static int32_t Padsynth_vstate_render_voice( Voice_state* vstate, Proc_state* proc_state, const Device_thread_state* proc_ts, const Au_state* au_state, const Work_buffers* wbs, int32_t buf_start, int32_t buf_stop, double tempo) { rassert(vstate != NULL); rassert(proc_state != NULL); rassert(proc_ts != NULL); rassert(au_state != NULL); rassert(wbs != NULL); rassert(tempo > 0); if (buf_start == buf_stop) return buf_start; const Device_state* dstate = &proc_state->parent; Padsynth_vstate* ps_vstate = (Padsynth_vstate*)vstate; const Proc_padsynth* ps = (const Proc_padsynth*)dstate->device->dimpl; if (ps->sample_map == NULL) { vstate->active = false; return buf_start; } // Get frequencies Work_buffer* freqs_wb = Device_thread_state_get_voice_buffer( proc_ts, DEVICE_PORT_TYPE_RECV, PORT_IN_PITCH); Work_buffer* pitches_wb = freqs_wb; if (isnan(ps_vstate->init_pitch)) ps_vstate->init_pitch = (pitches_wb != NULL) ? Work_buffer_get_contents(pitches_wb)[buf_start] : 0; if (freqs_wb == NULL) freqs_wb = Work_buffers_get_buffer_mut(wbs, PADSYNTH_WB_FIXED_PITCH); Proc_fill_freq_buffer(freqs_wb, pitches_wb, buf_start, buf_stop); const float* freqs = Work_buffer_get_contents(freqs_wb); // Get volume scales Work_buffer* scales_wb = Device_thread_state_get_voice_buffer( proc_ts, DEVICE_PORT_TYPE_RECV, PORT_IN_FORCE); Work_buffer* dBs_wb = scales_wb; if (scales_wb == NULL) scales_wb = Work_buffers_get_buffer_mut(wbs, PADSYNTH_WB_FIXED_FORCE); Proc_fill_scale_buffer(scales_wb, dBs_wb, buf_start, buf_stop); const float* scales = Work_buffer_get_contents(scales_wb); // Get output buffer for writing float* out_bufs[2] = { NULL }; Proc_state_get_voice_audio_out_buffers( proc_ts, PORT_OUT_AUDIO_L, PORT_OUT_COUNT, out_bufs); // Choose our sample const Padsynth_sample_entry* entry = Padsynth_sample_map_get_entry(ps->sample_map, ps_vstate->init_pitch); if (entry == NULL) { vstate->active = false; return buf_start; } // Render audio const float* sample_buf = Sample_get_buffer(entry->sample, 0); const int32_t length = Padsynth_sample_map_get_sample_length(ps->sample_map); const int32_t sample_rate = PADSYNTH_DEFAULT_AUDIO_RATE; const double sample_freq = cents_to_Hz(entry->center_pitch); const double audio_rate = dstate->audio_rate; const double init_pos = fmod(ps_vstate->pos, length); // the length may have changed bool is_state_pos_updated = false; for (int32_t ch = 0; ch < 2; ++ch) { float* out_buf = out_bufs[ch]; if (out_buf == NULL) continue; double pos = init_pos; if (ps->is_stereo_enabled && is_state_pos_updated) { pos += (length / 2); if (pos >= length) pos -= length; } for (int32_t i = buf_start; i < buf_stop; ++i) { const float freq = freqs[i]; const float scale = scales[i]; const int32_t pos1 = (int32_t)pos; const int32_t pos2 = pos1 + 1; const double lerp_val = pos - floor(pos); const float item1 = sample_buf[pos1]; const float item2 = sample_buf[pos2]; const float value = (float)lerp(item1, item2, lerp_val); out_buf[i] = value * scale; pos += (freq / sample_freq) * (sample_rate / audio_rate); while (pos >= length) pos -= length; } if (!ps->is_stereo_enabled || !is_state_pos_updated) { ps_vstate->pos = pos; is_state_pos_updated = true; } } if (ps->is_ramp_attack_enabled) Proc_ramp_attack(vstate, 2, out_bufs, buf_start, buf_stop, dstate->audio_rate); return buf_stop; }
static int32_t Add_vstate_render_voice( Voice_state* vstate, Proc_state* proc_state, const Device_thread_state* proc_ts, const Au_state* au_state, const Work_buffers* wbs, int32_t buf_start, int32_t buf_stop, double tempo) { rassert(vstate != NULL); rassert(proc_state != NULL); rassert(proc_ts != NULL); rassert(au_state != NULL); rassert(wbs != NULL); rassert(tempo > 0); const Device_state* dstate = &proc_state->parent; const Proc_add* add = (Proc_add*)proc_state->parent.device->dimpl; Add_vstate* add_state = (Add_vstate*)vstate; rassert(is_p2(ADD_BASE_FUNC_SIZE)); // Get frequencies Work_buffer* freqs_wb = Device_thread_state_get_voice_buffer( proc_ts, DEVICE_PORT_TYPE_RECV, PORT_IN_PITCH); Work_buffer* pitches_wb = freqs_wb; if (freqs_wb == NULL) freqs_wb = Work_buffers_get_buffer_mut(wbs, ADD_WORK_BUFFER_FIXED_PITCH); Proc_fill_freq_buffer(freqs_wb, pitches_wb, buf_start, buf_stop); const float* freqs = Work_buffer_get_contents(freqs_wb); // Get volume scales Work_buffer* scales_wb = Device_thread_state_get_voice_buffer( proc_ts, DEVICE_PORT_TYPE_RECV, PORT_IN_FORCE); Work_buffer* dBs_wb = scales_wb; if (scales_wb == NULL) scales_wb = Work_buffers_get_buffer_mut(wbs, ADD_WORK_BUFFER_FIXED_FORCE); Proc_fill_scale_buffer(scales_wb, dBs_wb, buf_start, buf_stop); const float* scales = Work_buffer_get_contents(scales_wb); // Get output buffer for writing float* out_bufs[2] = { NULL }; Proc_state_get_voice_audio_out_buffers( proc_ts, PORT_OUT_AUDIO_L, PORT_OUT_COUNT, out_bufs); // Get phase modulation signal const Work_buffer* mod_wbs[] = { Device_thread_state_get_voice_buffer( proc_ts, DEVICE_PORT_TYPE_RECV, PORT_IN_PHASE_MOD_L), Device_thread_state_get_voice_buffer( proc_ts, DEVICE_PORT_TYPE_RECV, PORT_IN_PHASE_MOD_R), }; for (int ch = 0; ch < 2; ++ch) { if (mod_wbs[ch] == NULL) { Work_buffer* zero_buf = Work_buffers_get_buffer_mut( wbs, (Work_buffer_type)(ADD_WORK_BUFFER_MOD_L + ch)); Work_buffer_clear(zero_buf, buf_start, buf_stop); mod_wbs[ch] = zero_buf; } } // Add base waveform tones const double inv_audio_rate = 1.0 / dstate->audio_rate; const float* base = Sample_get_buffer(add->base, 0); for (int h = 0; h < add_state->tone_limit; ++h) { const Add_tone* tone = &add->tones[h]; const double pitch_factor = tone->pitch_factor; const double volume_factor = tone->volume_factor; if ((pitch_factor <= 0) || (volume_factor <= 0)) continue; const double pannings[] = { -tone->panning, tone->panning, }; const double pitch_factor_inv_audio_rate = pitch_factor * inv_audio_rate; Add_tone_state* tone_state = &add_state->tones[h]; for (int32_t ch = 0; ch < 2; ++ch) { float* out_buf_ch = out_bufs[ch]; if (out_buf_ch == NULL) continue; const double panning_factor = 1 + pannings[ch]; const float* mod_values_ch = Work_buffer_get_contents(mod_wbs[ch]); double phase = tone_state->phase[ch]; int32_t res_slice_start = buf_start; while (res_slice_start < buf_stop) { int32_t res_slice_stop = buf_stop; // Get current pitch range const float first_mod_shift = mod_values_ch[res_slice_start] - add_state->prev_mod[ch]; const float first_phase_shift_abs = (float)fabs( first_mod_shift + (freqs[res_slice_start] * pitch_factor_inv_audio_rate)); int shift_exp = 0; const float shift_norm = frexpf(first_phase_shift_abs, &shift_exp); const float min_phase_shift_abs = ldexpf(0.5f, shift_exp); const float max_phase_shift_abs = min_phase_shift_abs * 2.0f; // Choose appropriate waveform resolution for current pitch range int32_t cur_size = ADD_BASE_FUNC_SIZE; if (isfinite(shift_norm) && (shift_norm > 0.0f)) { cur_size = (int32_t)ipowi(2, max(-shift_exp + 1, 3)); cur_size = min(cur_size, ADD_BASE_FUNC_SIZE * 2); rassert(is_p2(cur_size)); } const uint32_t cur_size_mask = (uint32_t)cur_size - 1; const int base_offset = (ADD_BASE_FUNC_SIZE * 4 - cur_size * 2); rassert(base_offset >= 0); rassert(base_offset < (ADD_BASE_FUNC_SIZE * 4) - 1); const float* cur_base = base + base_offset; // Get length of input compatible with current waveform resolution const int32_t res_check_stop = min(res_slice_stop, max(Work_buffer_get_const_start(freqs_wb), Work_buffer_get_const_start(mod_wbs[ch])) + 1); for (int32_t i = res_slice_start + 1; i < res_check_stop; ++i) { const float cur_mod_shift = mod_values_ch[i] - mod_values_ch[i - 1]; const float cur_phase_shift_abs = (float)fabs( cur_mod_shift + (freqs[i] * pitch_factor_inv_audio_rate)); if (cur_phase_shift_abs < min_phase_shift_abs || cur_phase_shift_abs > max_phase_shift_abs) { res_slice_stop = i; break; } } for (int32_t i = res_slice_start; i < res_slice_stop; ++i) { const float freq = freqs[i]; const float vol_scale = scales[i]; const float mod_val = mod_values_ch[i]; // Note: + mod_val is specific to phase modulation const double actual_phase = phase + mod_val; const double pos = actual_phase * cur_size; // Note: direct cast of negative doubles to uint32_t is undefined const uint32_t pos1 = (uint32_t)(int32_t)floor(pos) & cur_size_mask; const uint32_t pos2 = (pos1 + 1) & cur_size_mask; const float item1 = cur_base[pos1]; const float item_diff = cur_base[pos2] - item1; const double lerp_val = pos - floor(pos); const double value = (item1 + (lerp_val * item_diff)) * volume_factor * panning_factor; out_buf_ch[i] += (float)value * vol_scale; phase += freq * pitch_factor_inv_audio_rate; // Normalise to range [0, 1) if (phase >= 1) { phase -= 1; // Don't bother updating the phase if our frequency is too high if (phase >= 1) phase = tone_state->phase[ch]; } } rassert(res_slice_start < res_slice_stop); add_state->prev_mod[ch] = mod_values_ch[res_slice_stop - 1]; res_slice_start = res_slice_stop; } tone_state->phase[ch] = phase; } } if (add->is_ramp_attack_enabled) Proc_ramp_attack(vstate, 2, out_bufs, buf_start, buf_stop, dstate->audio_rate); return buf_stop; }
static void Compress_states_update( Compress_state cstates[2], const Proc_compress* compress, Work_buffer* gain_wb, Work_buffer* level_wbs[2], const Work_buffer* in_wbs[2], int32_t buf_start, int32_t buf_stop, int32_t audio_rate) { rassert(cstates != NULL); rassert(compress != NULL); rassert(gain_wb != NULL); rassert(level_wbs != NULL); rassert(level_wbs[0] != NULL); rassert(level_wbs[1] != NULL); rassert(in_wbs != NULL); rassert(buf_start >= 0); rassert(buf_stop > buf_start); // Get levels const float attack_mul = (float)dB_to_scale(6 / (compress->attack * 0.001 * audio_rate)); const float release_mul = (float)dB_to_scale(-6 / (compress->release * 0.001 * audio_rate)); for (int ch = 0; ch < 2; ++ch) { Compress_state* cstate = &cstates[ch]; rassert(cstate != NULL); if (in_wbs[ch] == NULL) continue; float level = cstate->level; float* levels = Work_buffer_get_contents_mut(level_wbs[ch]); const float* in = Work_buffer_get_contents(in_wbs[ch]); for (int32_t i = buf_start; i < buf_stop; ++i) { const float in_abs = fabsf(in[i]); if (in_abs > level) { level *= attack_mul; level = min(level, in_abs); } else { level *= release_mul; level = max(level, max((float)MIN_LEVEL, in_abs)); } levels[i] = level; } cstate->level = level; } if ((in_wbs[0] != NULL) && (in_wbs[1] != NULL)) { // Get maximum levels for (int32_t i = buf_start; i < buf_stop; ++i) level_wbs[0] = max(level_wbs[0], level_wbs[1]); } const Work_buffer* applied_levels_wb = (in_wbs[0] == NULL) ? level_wbs[1] : level_wbs[0]; const float* applied_levels = Work_buffer_get_contents(applied_levels_wb); Work_buffer_clear(gain_wb, buf_start, buf_stop); float* gains = Work_buffer_get_contents_mut(gain_wb); for (int32_t i = buf_start; i < buf_stop; ++i) gains[i] = 1.0f; if (compress->upward_enabled) { // Apply upward compression const double upward_threshold_dB = compress->downward_enabled ? min(compress->upward_threshold, compress->downward_threshold) : compress->upward_threshold; const float threshold = (float)dB_to_scale(upward_threshold_dB); const float inv_ratio = (float)(1.0 / compress->upward_ratio); const float max_gain = (float)dB_to_scale(compress->upward_range); for (int32_t i = buf_start; i < buf_stop; ++i) { const float level = applied_levels[i]; if (level < threshold) { const float diff = threshold / level; const float gain = threshold / (powf(diff, inv_ratio) * level); gains[i] = min(gain, max_gain); } } } if (compress->downward_enabled) { // Apply downward compression const float threshold = (float)dB_to_scale(compress->downward_threshold); const float inv_ratio = (float)(1.0 / compress->downward_ratio); const float min_gain = (float)dB_to_scale(-compress->downward_range); for (int32_t i = buf_start; i < buf_stop; ++i) { const float level = applied_levels[i]; if (level > threshold) { const float diff = level / threshold; const float gain = (threshold * powf(diff, inv_ratio)) / level; gains[i] = max(gain, min_gain); } } } return; }
int32_t Noise_vstate_render_voice( Voice_state* vstate, Proc_state* proc_state, const Device_thread_state* proc_ts, const Au_state* au_state, const Work_buffers* wbs, int32_t frame_count, double tempo) { rassert(vstate != NULL); rassert(proc_state != NULL); rassert(proc_ts != NULL); rassert(au_state != NULL); rassert(wbs != NULL); rassert(frame_count > 0); rassert(tempo > 0); // double max_amp = 0; // fprintf(stderr, "bufs are %p and %p\n", ins->bufs[0], ins->bufs[1]); // Get volume scales Work_buffer* scales_wb = Device_thread_state_get_voice_buffer( proc_ts, DEVICE_PORT_TYPE_RECV, PORT_IN_FORCE, NULL); Work_buffer* dBs_wb = scales_wb; if ((dBs_wb != NULL) && Work_buffer_is_valid(dBs_wb, 0) && Work_buffer_is_final(dBs_wb, 0) && (Work_buffer_get_const_start(dBs_wb, 0) == 0) && (Work_buffer_get_contents(dBs_wb, 0)[0] == -INFINITY)) { // We are only getting silent force from this point onwards vstate->active = false; return 0; } if ((scales_wb == NULL) || !Work_buffer_is_valid(scales_wb, 0)) scales_wb = Work_buffers_get_buffer_mut(wbs, NOISE_WB_FIXED_FORCE, 1); Proc_fill_scale_buffer(scales_wb, dBs_wb, frame_count); const float* scales = Work_buffer_get_contents(scales_wb, 0); Noise_pstate* noise_state = (Noise_pstate*)proc_state; Noise_vstate* noise_vstate = (Noise_vstate*)vstate; // Get output buffer Work_buffer* out_wb = Proc_get_voice_output_2ch(proc_ts, PORT_OUT_AUDIO_L); if (out_wb == NULL) { vstate->active = false; return 0; } float* out_buffer = Work_buffer_get_contents_mut(out_wb, 0); const int order = noise_state->order; if (order >= 0) { float* out = out_buffer; for (int32_t i = 0; i < frame_count; ++i) { *out++ = scales[i] * (float)dc_zero_filter( order, noise_vstate->buf[0], Random_get_float_signal(&noise_vstate->rands[0])); *out++ = scales[i] * (float)dc_zero_filter( order, noise_vstate->buf[1], Random_get_float_signal(&noise_vstate->rands[1])); } } else { float* out = out_buffer; for (int32_t i = 0; i < frame_count; ++i) { *out++ = scales[i] * (float)dc_pole_filter( -order, noise_vstate->buf[0], Random_get_float_signal(&noise_vstate->rands[0])); *out++ = scales[i] * (float)dc_pole_filter( -order, noise_vstate->buf[1], Random_get_float_signal(&noise_vstate->rands[1])); } } #if 0 for (int ch = 0; ch < 2; ++ch) { float* out_buffer = out_buffers[ch]; if (out_buffer == NULL) continue; if (noise_state->order >= 0) { for (int32_t i = 0; i < frame_count; ++i) { const double val = dc_zero_filter( noise_state->order, noise_vstate->buf[ch], Random_get_float_signal(&noise_vstate->rands[ch])); out_buffer[i] = (float)val * scales[i]; } } else { for (int32_t i = 0; i < frame_count; ++i) { const double val = dc_pole_filter( -noise_state->order, noise_vstate->buf[ch], Random_get_float_signal(&noise_vstate->rands[ch])); out_buffer[i] = (float)val * scales[i]; } } } #endif const int32_t audio_rate = proc_state->parent.audio_rate; Proc_ramp_attack(vstate, out_wb, frame_count, audio_rate); // fprintf(stderr, "max_amp is %lf\n", max_amp); return frame_count; }