MirrorMirror
/
headphones
mirror of https://github.com/ploopyco/headphones.git
2
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Shift some load of core1

This commit is contained in:
George Norton 2023-08-20 15:19:05 +01:00
parent 12f94d2250
commit df277c6556
1 changed files with 12 additions and 11 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
firmware/code/run.c
View File

@ -124,21 +124,24 @@ static void __no_inline_not_in_flash_func(_as_audio_packet)(struct usb_endpoint
int32_t *out = (int32_t *) userbuf;
int samples = usb_buffer->data_len / 2;
for (int i = 0; i < samples; i ++) {
out[i] = fix16_mul(norm_fix3_28_from_s16sample(in[i]), preprocessing.preamp);
}
multicore_fifo_push_blocking(samples);
if (preprocessing.reverse_stereo) {
multicore_fifo_push_blocking((uintptr_t) (in - 1));
in ++;
multicore_fifo_push_blocking((uintptr_t) (out - 1));
out ++;
}
else {
multicore_fifo_push_blocking((uintptr_t) in);
multicore_fifo_push_blocking((uintptr_t) out);
}
for (int i = 0; i < samples; i += 2) {
fix3_28_t sample = fix16_mul(norm_fix3_28_from_s16sample(in[i]), preprocessing.preamp);
for (int j = 0; j < filter_stages; j++) {
sample = bqf_transform(sample, &bqf_filters_left[j], &bqf_filters_mem_left[j]);
out[i] = bqf_transform(out[i], &bqf_filters_left[j], &bqf_filters_mem_left[j]);
}
out[i] = (int32_t) norm_fix3_28_to_s16sample(sample);
out[i] = (int32_t) norm_fix3_28_to_s16sample(out[i]);
}
// Signal to core 1 that we have processed our samples, so it can write to I2S
@ -154,21 +157,19 @@ static void __no_inline_not_in_flash_func(_as_audio_packet)(struct usb_endpoint
void __no_inline_not_in_flash_func(core1_entry)() {
uint32_t *userbuf = (uint32_t *) multicore_fifo_pop_blocking();
int32_t *out = (int32_t *) userbuf;
// Signal that the thread has started
multicore_fifo_push_blocking(CORE1_READY);
while (true) {
const uint32_t samples = multicore_fifo_pop_blocking();
int16_t *in = (int16_t *) multicore_fifo_pop_blocking();
int32_t *out = (int32_t *) multicore_fifo_pop_blocking();
for (int i = 1; i < samples; i += 2) {
fix3_28_t sample = fix16_mul(norm_fix3_28_from_s16sample(in[i]), preprocessing.preamp);
for (int j = 0; j < filter_stages; j++) {
sample = bqf_transform(sample, &bqf_filters_right[j], &bqf_filters_mem_right[j]);
out[i] = bqf_transform(out[i], &bqf_filters_right[j], &bqf_filters_mem_right[j]);
}
out[i] = (int32_t) norm_fix3_28_to_s16sample(sample);
out[i] = (int32_t) norm_fix3_28_to_s16sample(out[i]);
}
// Wait for Core 0 to finish running its filtering before we apply config updates