mirror of
https://github.com/portapack-mayhem/mayhem-firmware.git
synced 2025-08-23 09:47:47 +00:00
Formatted code (#1007)
* Updated style * Updated files * fixed new line * Updated spacing * File fix WIP * Updated to clang 13 * updated comment style * Removed old comment code
This commit is contained in:
jLynx
@@ -28,97 +28,95 @@
|
||||
#include <cstdint>
|
||||
|
||||
void AFSKProcessor::execute(const buffer_c8_t& buffer) {
|
||||
|
||||
// This is called at 2.28M/2048 = 1113Hz
|
||||
|
||||
if (!configured) return;
|
||||
|
||||
for (size_t i = 0; i<buffer.count; i++) {
|
||||
// This is called at 2.28M/2048 = 1113Hz
|
||||
|
||||
if (sample_count >= afsk_samples_per_bit) {
|
||||
if (configured) {
|
||||
cur_word = *word_ptr;
|
||||
|
||||
if (!cur_word) {
|
||||
// End of data
|
||||
if (repeat_counter < afsk_repeat) {
|
||||
// Repeat
|
||||
bit_pos = 0;
|
||||
word_ptr = (uint16_t*)shared_memory.bb_data.data;
|
||||
cur_word = *word_ptr;
|
||||
txprogress_message.done = false;
|
||||
txprogress_message.progress = repeat_counter + 1;
|
||||
shared_memory.application_queue.push(txprogress_message);
|
||||
repeat_counter++;
|
||||
} else {
|
||||
// Stop
|
||||
cur_word = 0;
|
||||
txprogress_message.done = true;
|
||||
shared_memory.application_queue.push(txprogress_message);
|
||||
configured = false;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
cur_bit = (cur_word >> (symbol_count - bit_pos)) & 1;
|
||||
if (!configured) return;
|
||||
|
||||
if (bit_pos >= symbol_count) {
|
||||
bit_pos = 0;
|
||||
word_ptr++;
|
||||
} else {
|
||||
bit_pos++;
|
||||
}
|
||||
|
||||
sample_count = 0;
|
||||
} else {
|
||||
sample_count++;
|
||||
}
|
||||
|
||||
if (cur_bit)
|
||||
tone_phase += afsk_phase_inc_mark;
|
||||
else
|
||||
tone_phase += afsk_phase_inc_space;
|
||||
for (size_t i = 0; i < buffer.count; i++) {
|
||||
if (sample_count >= afsk_samples_per_bit) {
|
||||
if (configured) {
|
||||
cur_word = *word_ptr;
|
||||
|
||||
tone_sample = sine_table_i8[(tone_phase & 0xFF000000U) >> 24];
|
||||
if (!cur_word) {
|
||||
// End of data
|
||||
if (repeat_counter < afsk_repeat) {
|
||||
// Repeat
|
||||
bit_pos = 0;
|
||||
word_ptr = (uint16_t*)shared_memory.bb_data.data;
|
||||
cur_word = *word_ptr;
|
||||
txprogress_message.done = false;
|
||||
txprogress_message.progress = repeat_counter + 1;
|
||||
shared_memory.application_queue.push(txprogress_message);
|
||||
repeat_counter++;
|
||||
} else {
|
||||
// Stop
|
||||
cur_word = 0;
|
||||
txprogress_message.done = true;
|
||||
shared_memory.application_queue.push(txprogress_message);
|
||||
configured = false;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
delta = tone_sample * fm_delta;
|
||||
|
||||
phase += delta;
|
||||
sphase = phase + (64 << 24);
|
||||
cur_bit = (cur_word >> (symbol_count - bit_pos)) & 1;
|
||||
|
||||
re = (sine_table_i8[(sphase & 0xFF000000U) >> 24]);
|
||||
im = (sine_table_i8[(phase & 0xFF000000U) >> 24]);
|
||||
|
||||
buffer.p[i] = {re, im};
|
||||
}
|
||||
if (bit_pos >= symbol_count) {
|
||||
bit_pos = 0;
|
||||
word_ptr++;
|
||||
} else {
|
||||
bit_pos++;
|
||||
}
|
||||
|
||||
sample_count = 0;
|
||||
} else {
|
||||
sample_count++;
|
||||
}
|
||||
|
||||
if (cur_bit)
|
||||
tone_phase += afsk_phase_inc_mark;
|
||||
else
|
||||
tone_phase += afsk_phase_inc_space;
|
||||
|
||||
tone_sample = sine_table_i8[(tone_phase & 0xFF000000U) >> 24];
|
||||
|
||||
delta = tone_sample * fm_delta;
|
||||
|
||||
phase += delta;
|
||||
sphase = phase + (64 << 24);
|
||||
|
||||
re = (sine_table_i8[(sphase & 0xFF000000U) >> 24]);
|
||||
im = (sine_table_i8[(phase & 0xFF000000U) >> 24]);
|
||||
|
||||
buffer.p[i] = {re, im};
|
||||
}
|
||||
}
|
||||
|
||||
void AFSKProcessor::on_message(const Message* const msg) {
|
||||
const auto message = *reinterpret_cast<const AFSKTxConfigureMessage*>(msg);
|
||||
|
||||
if (message.id == Message::ID::AFSKTxConfigure) {
|
||||
if (message.samples_per_bit) {
|
||||
afsk_samples_per_bit = message.samples_per_bit;
|
||||
afsk_phase_inc_mark = message.phase_inc_mark * AFSK_DELTA_COEF;
|
||||
afsk_phase_inc_space = message.phase_inc_space * AFSK_DELTA_COEF;
|
||||
afsk_repeat = message.repeat - 1;
|
||||
fm_delta = message.fm_delta * (0xFFFFFFULL / AFSK_SAMPLERATE);
|
||||
symbol_count = message.symbol_count - 1;
|
||||
const auto message = *reinterpret_cast<const AFSKTxConfigureMessage*>(msg);
|
||||
|
||||
sample_count = afsk_samples_per_bit;
|
||||
repeat_counter = 0;
|
||||
bit_pos = 0;
|
||||
word_ptr = (uint16_t*)shared_memory.bb_data.data;
|
||||
cur_word = 0;
|
||||
cur_bit = 0;
|
||||
configured = true;
|
||||
} else
|
||||
configured = false; // Kill
|
||||
}
|
||||
if (message.id == Message::ID::AFSKTxConfigure) {
|
||||
if (message.samples_per_bit) {
|
||||
afsk_samples_per_bit = message.samples_per_bit;
|
||||
afsk_phase_inc_mark = message.phase_inc_mark * AFSK_DELTA_COEF;
|
||||
afsk_phase_inc_space = message.phase_inc_space * AFSK_DELTA_COEF;
|
||||
afsk_repeat = message.repeat - 1;
|
||||
fm_delta = message.fm_delta * (0xFFFFFFULL / AFSK_SAMPLERATE);
|
||||
symbol_count = message.symbol_count - 1;
|
||||
|
||||
sample_count = afsk_samples_per_bit;
|
||||
repeat_counter = 0;
|
||||
bit_pos = 0;
|
||||
word_ptr = (uint16_t*)shared_memory.bb_data.data;
|
||||
cur_word = 0;
|
||||
cur_bit = 0;
|
||||
configured = true;
|
||||
} else
|
||||
configured = false; // Kill
|
||||
}
|
||||
}
|
||||
|
||||
int main() {
|
||||
EventDispatcher event_dispatcher { std::make_unique<AFSKProcessor>() };
|
||||
event_dispatcher.run();
|
||||
return 0;
|
||||
EventDispatcher event_dispatcher{std::make_unique<AFSKProcessor>()};
|
||||
event_dispatcher.run();
|
||||
return 0;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user