radio95/fm95
0
1
Fork 0
mirror of https://github.com/radio95-rnt/fm95.git synced 2026-02-27 03:23:54 +01:00
Code Issues Activity

this

Browse Source
This commit is contained in:
KubaPro010
2025-03-27 21:19:33 +01:00
parent 7594f352c1
commit 4121657da9
3 changed files with 22 additions and 46 deletions
Download Patch File Download Diff File Expand all files Collapse all files

24
lib/oscillator.c
View File

@@ -35,22 +35,8 @@ float get_oscillator_cos_multiplier_ni(Oscillator *osc, float multiplier) {
}
void advance_oscillator(Oscillator *osc) {
#if USE_NEON // Use NEON if available
float32x4_t v_phase = vdupq_n_f32(osc->phase);
float32x4_t v_increment = vdupq_n_f32(osc->phase_increment);
float32x4_t v_twopi = vdupq_n_f32(M_2PI);
v_phase = vaddq_f32(v_phase, v_increment);
uint32x4_t v_mask = vcgeq_f32(v_phase, v_twopi); // Check if phase >= 2π
float32x4_t v_wrapped = vsubq_f32(v_phase, v_twopi);
v_phase = vbslq_f32(v_mask, v_wrapped, v_phase);
osc->phase = vgetq_lane_f32(v_phase, 0);
#else // Scalar fallback if NEON is not available
osc->phase += osc->phase_increment;
if (osc->phase >= M_2PI) {
osc->phase -= M_2PI;
}
#endif
}
osc->phase += osc->phase_increment;
if (osc->phase >= M_2PI) {
osc->phase -= M_2PI;
}
}