gr-satnogs/lib/debug_msg_source_impl.cc

91 lines
2.4 KiB
C++

/* -*- c++ -*- */
/*
* gr-satnogs: SatNOGS GNU Radio Out-Of-Tree Module
*
* Copyright (C) 2016, 2019
* Libre Space Foundation <http://libre.space>
*
* 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 3 of the License, 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. If not, see <http://www.gnu.org/licenses/>.
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <gnuradio/io_signature.h>
#include "debug_msg_source_impl.h"
#include <thread>
#include <chrono>
namespace gr {
namespace satnogs {
debug_msg_source::sptr
debug_msg_source::make(const std::string &msg, double delay, bool repeat)
{
return gnuradio::get_initial_sptr(
new debug_msg_source_impl(msg, delay, repeat));
}
/*
* The private constructor
*/
debug_msg_source_impl::debug_msg_source_impl(const std::string &msg,
double delay, bool repeat) :
gr::block("debug_msg_source", gr::io_signature::make(0, 0, 0),
gr::io_signature::make(0, 0, 0)),
d_buf_len(msg.length()),
d_delay(delay),
d_repeat(repeat),
d_running(true)
{
d_buf = new uint8_t[msg.length()];
memcpy(d_buf, msg.c_str(), msg.length());
message_port_register_out(pmt::mp("msg"));
boost::shared_ptr<boost::thread> (
new boost::thread(
boost::bind(&debug_msg_source_impl::msg_sender, this)));
}
void
debug_msg_source_impl::msg_sender()
{
pmt::pmt_t msg = pmt::make_blob(d_buf, d_buf_len);
if (d_repeat) {
while (d_running) {
std::this_thread::sleep_for(std::chrono::milliseconds((size_t)(d_delay * 1e3)));
message_port_pub(pmt::mp("msg"), msg);
}
}
else {
std::this_thread::sleep_for(std::chrono::milliseconds((size_t)(d_delay * 1e3)));
message_port_pub(pmt::mp("msg"), msg);
}
}
/*
* Our virtual destructor.
*/
debug_msg_source_impl::~debug_msg_source_impl()
{
d_running = false;
d_thread->join();
delete[] d_buf;
}
} /* namespace satnogs */
} /* namespace gr */