/* * Copyright (C) 2015 Jared Boone, ShareBrained Technology, Inc. * Copyright (C) 2017 Furrtek * * This file is part of PortaPack. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2, or (at your option) * any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; see the file COPYING. If not, write to * the Free Software Foundation, Inc., 51 Franklin Street, * Boston, MA 02110-1301, USA. */ #include "proc_sonde.hpp" #include "dsp_fir_taps.hpp" #include "event_m4.hpp" #include "audio_output.hpp" SondeProcessor::SondeProcessor() { decim_0.configure(taps_11k0_decim_0.taps, 33554432); decim_1.configure(taps_11k0_decim_1.taps, 131072); audio_output.configure(false); } void SondeProcessor::execute(const buffer_c8_t& buffer) { /* 2.4576MHz, 2048 samples */ const auto decim_0_out = decim_0.execute(buffer, dst_buffer); const auto decim_1_out = decim_1.execute(decim_0_out, dst_buffer); const auto decimator_out = decim_1_out; /* 38.4kHz, 32 samples */ feed_channel_stats(decimator_out); for (size_t i=0; iid) { case Message::ID::RequestSignal: if ((*reinterpret_cast(msg)).signal == RequestSignalMessage::Signal::BeepRequest) { play_beep(); chThdSleepMilliseconds(100); stop_beep(); } break; case Message::ID::PitchRSSIConfigure: pitch_rssi_config(*reinterpret_cast(msg)); break; default: break; } } void SondeProcessor::play_beep() { beep_playing = true; } void SondeProcessor::stop_beep() { beep_playing = false; } void SondeProcessor::generate_beep() { // if(curr_sample == sizeof(audio_buffer.p)) { // audio_output.write(audio_buffer); // curr_sample = 0; // //tone_phase = 0; // } // else if(beep_playing) { // audio_buffer.p[curr_sample++] = (sine_table_i16[(tone_phase & 0xFF000000U) >> 24]); // tone_phase += tone_delta; // } // else { // audio_buffer.p[curr_sample++] = 0; // tone_phase = 0; // } for(uint8_t i = 0; i < sizeof(audio_buffer.p); i++) { audio_buffer.p[i] = (sine_table_i16_1024[(tone_phase & 0xFFC00000U) >> 22]); tone_phase += tone_delta; } audio_output.write(audio_buffer); } void SondeProcessor::generate_silence() { for(uint8_t i = 0; i < sizeof(audio_buffer.p); i++) { audio_buffer.p[i] = 0; tone_phase = 0; } audio_output.write(audio_buffer); } void SondeProcessor::pitch_rssi_config(const PitchRSSIConfigureMessage& message) { pitch_rssi_enabled = message.enabled; tone_delta = (message.rssi + 1000) * ((1ULL << 32) / 24000); } int main() { EventDispatcher event_dispatcher { std::make_unique() }; event_dispatcher.run(); return 0; }