diff options
| author | Marcus Müller <mmueller@gnuradio.org> | 2019-08-07 21:45:12 +0200 |
|---|---|---|
| committer | Marcus Müller <marcus@hostalia.de> | 2019-08-09 23:04:28 +0200 |
| commit | f7bbf2c1d8d780294f3e016aff239ca35eb6516e (patch) | |
| tree | e09ab6112e02b2215b2d59ac24d3d6ea2edac745 /gr-digital/lib/crc32_async_bb_impl.cc | |
| parent | 78431dc6941e3acc67c858277dfe4a0ed583643c (diff) | |
Tree: clang-format without the include sorting
Diffstat (limited to 'gr-digital/lib/crc32_async_bb_impl.cc')
| -rw-r--r-- | gr-digital/lib/crc32_async_bb_impl.cc | 172 |
1 files changed, 84 insertions, 88 deletions
diff --git a/gr-digital/lib/crc32_async_bb_impl.cc b/gr-digital/lib/crc32_async_bb_impl.cc index e5c8096d28..0dc16cf5d6 100644 --- a/gr-digital/lib/crc32_async_bb_impl.cc +++ b/gr-digital/lib/crc32_async_bb_impl.cc @@ -29,95 +29,91 @@ #include "crc32_async_bb_impl.h" namespace gr { - namespace digital { - - crc32_async_bb::sptr - crc32_async_bb::make(bool check) - { - return gnuradio::get_initial_sptr - (new crc32_async_bb_impl(check)); - } - - crc32_async_bb_impl::crc32_async_bb_impl(bool check) - : block("crc32_async_bb", - io_signature::make(0, 0, 0), - io_signature::make(0, 0, 0)), - d_npass(0), d_nfail(0) - { - d_in_port = pmt::mp("in"); - d_out_port = pmt::mp("out"); - - message_port_register_in(d_in_port); - message_port_register_out(d_out_port); - - if(check) - set_msg_handler(d_in_port, boost::bind(&crc32_async_bb_impl::check, this ,_1) ); - else - set_msg_handler(d_in_port, boost::bind(&crc32_async_bb_impl::calc, this ,_1) ); - } - - crc32_async_bb_impl::~crc32_async_bb_impl() - { - } - - void - crc32_async_bb_impl::calc(pmt::pmt_t msg) - { - // extract input pdu - pmt::pmt_t meta(pmt::car(msg)); - pmt::pmt_t bytes(pmt::cdr(msg)); - - unsigned int crc; - size_t pkt_len(0); - const uint8_t* bytes_in = pmt::u8vector_elements(bytes, pkt_len); - uint8_t* bytes_out = (uint8_t*)volk_malloc(4 + pkt_len*sizeof(uint8_t), - volk_get_alignment()); - - d_crc_impl.reset(); - d_crc_impl.process_bytes(bytes_in, pkt_len); - crc = d_crc_impl(); - memcpy((void*)bytes_out, (const void*)bytes_in, pkt_len); - memcpy((void*)(bytes_out + pkt_len), &crc, 4); // FIXME big-endian/little-endian, this might be wrong - - pmt::pmt_t output = pmt::init_u8vector(pkt_len+4, bytes_out); // this copies the values from bytes_out into the u8vector - pmt::pmt_t msg_pair = pmt::cons(meta, output); - message_port_pub(d_out_port, msg_pair); - volk_free(bytes_out); - } - - void - crc32_async_bb_impl::check(pmt::pmt_t msg) - { - // extract input pdu - pmt::pmt_t meta(pmt::car(msg)); - pmt::pmt_t bytes(pmt::cdr(msg)); - - unsigned int crc; - size_t pkt_len(0); - const uint8_t* bytes_in = pmt::u8vector_elements(bytes, pkt_len); - - d_crc_impl.reset(); - d_crc_impl.process_bytes(bytes_in, pkt_len-4); - crc = d_crc_impl(); - if(crc != *(unsigned int*)(bytes_in+pkt_len-4)) { // Drop package +namespace digital { + +crc32_async_bb::sptr crc32_async_bb::make(bool check) +{ + return gnuradio::get_initial_sptr(new crc32_async_bb_impl(check)); +} + +crc32_async_bb_impl::crc32_async_bb_impl(bool check) + : block("crc32_async_bb", io_signature::make(0, 0, 0), io_signature::make(0, 0, 0)), + d_npass(0), + d_nfail(0) +{ + d_in_port = pmt::mp("in"); + d_out_port = pmt::mp("out"); + + message_port_register_in(d_in_port); + message_port_register_out(d_out_port); + + if (check) + set_msg_handler(d_in_port, boost::bind(&crc32_async_bb_impl::check, this, _1)); + else + set_msg_handler(d_in_port, boost::bind(&crc32_async_bb_impl::calc, this, _1)); +} + +crc32_async_bb_impl::~crc32_async_bb_impl() {} + +void crc32_async_bb_impl::calc(pmt::pmt_t msg) +{ + // extract input pdu + pmt::pmt_t meta(pmt::car(msg)); + pmt::pmt_t bytes(pmt::cdr(msg)); + + unsigned int crc; + size_t pkt_len(0); + const uint8_t* bytes_in = pmt::u8vector_elements(bytes, pkt_len); + uint8_t* bytes_out = + (uint8_t*)volk_malloc(4 + pkt_len * sizeof(uint8_t), volk_get_alignment()); + + d_crc_impl.reset(); + d_crc_impl.process_bytes(bytes_in, pkt_len); + crc = d_crc_impl(); + memcpy((void*)bytes_out, (const void*)bytes_in, pkt_len); + memcpy((void*)(bytes_out + pkt_len), + &crc, + 4); // FIXME big-endian/little-endian, this might be wrong + + pmt::pmt_t output = pmt::init_u8vector( + pkt_len + 4, + bytes_out); // this copies the values from bytes_out into the u8vector + pmt::pmt_t msg_pair = pmt::cons(meta, output); + message_port_pub(d_out_port, msg_pair); + volk_free(bytes_out); +} + +void crc32_async_bb_impl::check(pmt::pmt_t msg) +{ + // extract input pdu + pmt::pmt_t meta(pmt::car(msg)); + pmt::pmt_t bytes(pmt::cdr(msg)); + + unsigned int crc; + size_t pkt_len(0); + const uint8_t* bytes_in = pmt::u8vector_elements(bytes, pkt_len); + + d_crc_impl.reset(); + d_crc_impl.process_bytes(bytes_in, pkt_len - 4); + crc = d_crc_impl(); + if (crc != *(unsigned int*)(bytes_in + pkt_len - 4)) { // Drop package d_nfail++; return; - } - d_npass++; - - pmt::pmt_t output = pmt::init_u8vector(pkt_len-4, bytes_in); - pmt::pmt_t msg_pair = pmt::cons(meta, output); - message_port_pub(d_out_port, msg_pair); } - - int - crc32_async_bb_impl::general_work(int noutput_items, - gr_vector_int &ninput_items, - gr_vector_const_void_star &input_items, - gr_vector_void_star &output_items) - { - return noutput_items; - } - - } /* namespace digital */ + d_npass++; + + pmt::pmt_t output = pmt::init_u8vector(pkt_len - 4, bytes_in); + pmt::pmt_t msg_pair = pmt::cons(meta, output); + message_port_pub(d_out_port, msg_pair); +} + +int crc32_async_bb_impl::general_work(int noutput_items, + gr_vector_int& ninput_items, + gr_vector_const_void_star& input_items, + gr_vector_void_star& output_items) +{ + return noutput_items; +} + +} /* namespace digital */ } /* namespace gr */ |