blob: 2c1f197dd82532d7c3d01cc396743b2e129bae3f [file] [log] [blame]
piotr6c692872014-02-08 14:16:26 +01001/* -*- c++ -*- */
ptrkrysik529895b2014-12-02 18:07:38 +01002/*
3 * @file
4 * @author Piotr Krysik <ptrkrysik@gmail.com>
5 * @section LICENSE
6 *
7 * Gr-gsm is free software; you can redistribute it and/or modify
piotr6c692872014-02-08 14:16:26 +01008 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 3, or (at your option)
10 * any later version.
ptrkrysik529895b2014-12-02 18:07:38 +010011 *
12 * Gr-gsm is distributed in the hope that it will be useful,
piotr6c692872014-02-08 14:16:26 +010013 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
ptrkrysik529895b2014-12-02 18:07:38 +010016 *
piotr6c692872014-02-08 14:16:26 +010017 * You should have received a copy of the GNU General Public License
ptrkrysik529895b2014-12-02 18:07:38 +010018 * along with gr-gsm; see the file COPYING. If not, write to
piotr6c692872014-02-08 14:16:26 +010019 * the Free Software Foundation, Inc., 51 Franklin Street,
20 * Boston, MA 02110-1301, USA.
21 */
22
23#ifdef HAVE_CONFIG_H
24#include "config.h"
25#endif
26
27#include <gnuradio/io_signature.h>
ptrkrysik3be74a72014-12-13 10:11:00 +010028#include <grgsm/gsmtap.h>
Martin Jesper Low Madsenaf769642015-04-28 22:33:43 +020029#include <grgsm/endian.h>
piotr6d152d92014-02-21 00:02:44 +010030#include <iterator>
31#include <algorithm>
piotrfaacc722014-07-20 23:48:32 +020032#include "bursts_printer_impl.h"
piotrc00ce9c2014-08-04 11:21:24 +020033#include <unistd.h>
34
35#include <iostream>
piotr6c692872014-02-08 14:16:26 +010036
37namespace gr {
38 namespace gsm {
piotrc00ce9c2014-08-04 11:21:24 +020039 boost::mutex printer_mutex;
piotr6d152d92014-02-21 00:02:44 +010040 void bursts_printer_impl::bursts_print(pmt::pmt_t msg)
piotr6c692872014-02-08 14:16:26 +010041 {
ptrkrysik617ba032014-11-21 10:11:05 +010042 pmt::pmt_t header_plus_burst = pmt::cdr(msg);
piotr6c692872014-02-08 14:16:26 +010043
ptrkrysik617ba032014-11-21 10:11:05 +010044 gsmtap_hdr * header = (gsmtap_hdr *)pmt::blob_data(header_plus_burst);
45 int8_t * burst = (int8_t *)(pmt::blob_data(header_plus_burst))+sizeof(gsmtap_hdr);
46 size_t burst_len=pmt::blob_length(header_plus_burst)-sizeof(gsmtap_hdr);
Roman Khassraf63444962015-07-13 13:42:57 +020047 uint32_t frame_nr = be32toh(header->frame_number);
Martin Jesper Low Madsenaf769642015-04-28 22:33:43 +020048
Jacob Gilbert607a09e2014-12-13 10:41:20 -080049 std::cout << d_prepend_string;
Martin Jesper Low Madsenaf769642015-04-28 22:33:43 +020050 if (d_prepend_fnr)
Roman Khassraf717b57b2015-04-12 18:09:45 +020051 {
Roman Khassraf63444962015-07-13 13:42:57 +020052 std::cout << frame_nr;
Martin Jesper Low Madsenaf769642015-04-28 22:33:43 +020053 }
Roman Khassraf717b57b2015-04-12 18:09:45 +020054
Roman Khassraf63444962015-07-13 13:42:57 +020055 if (d_prepend_fnr && d_prepend_frame_count)
piotr6c692872014-02-08 14:16:26 +010056 {
Roman Khassraf63444962015-07-13 13:42:57 +020057 std::cout << " ";
piotr6c692872014-02-08 14:16:26 +010058 }
Roman Khassraf63444962015-07-13 13:42:57 +020059
60 if (d_prepend_frame_count)
61 {
62 // calculate frame count for A5
63 uint16_t t1 = frame_nr/1326;
64 uint8_t t2 = frame_nr % 26;
65 uint8_t t3 = frame_nr % 51;
66 uint32_t frame_count = (t1<<11)|(t3<<5)|t2;
67 std::cout << frame_count;
68 }
69
70 if (d_prepend_fnr || d_prepend_frame_count)
71 {
72 std::cout << ":";
73 }
74
75 if (d_print_payload_only)
76 {
77 for (int ii=0; ii<57; ii++)
78 {
79 std::cout << std::setprecision(1) << static_cast<int>(burst[ii + 3]);
80 }
81 for (int ii=0; ii<57; ii++)
82 {
83 std::cout << std::setprecision(1) << static_cast<int>(burst[ii + 88]);
84 }
85 }
86 else
87 {
88 for(int ii=0; ii<burst_len; ii++)
89 {
90 std::cout << std::setprecision(1) << static_cast<int>(burst[ii]);
91 }
92 }
93
piotr6c692872014-02-08 14:16:26 +010094 std::cout << std::endl;
95 }
Martin Jesper Low Madsenaf769642015-04-28 22:33:43 +020096
piotr6c692872014-02-08 14:16:26 +010097 bursts_printer::sptr
Roman Khassraf63444962015-07-13 13:42:57 +020098 bursts_printer::make(pmt::pmt_t prepend_string, bool prepend_fnr,
99 bool prepend_frame_count, bool print_payload_only)
piotr6c692872014-02-08 14:16:26 +0100100 {
101 return gnuradio::get_initial_sptr
Roman Khassraf63444962015-07-13 13:42:57 +0200102 (new bursts_printer_impl(prepend_string, prepend_fnr, prepend_frame_count, print_payload_only));
piotr6c692872014-02-08 14:16:26 +0100103 }
104
105 /*
106 * The private constructor
107 */
Roman Khassraf63444962015-07-13 13:42:57 +0200108 bursts_printer_impl::bursts_printer_impl(pmt::pmt_t prepend_string, bool prepend_fnr,
109 bool prepend_frame_count, bool print_payload_only)
piotr6c692872014-02-08 14:16:26 +0100110 : gr::block("bursts_printer",
111 gr::io_signature::make(0, 0, 0),
112 gr::io_signature::make(0, 0, 0))
113 {
Jacob Gilbert607a09e2014-12-13 10:41:20 -0800114 d_prepend_string = prepend_string;
Roman Khassraf717b57b2015-04-12 18:09:45 +0200115 d_prepend_fnr = prepend_fnr;
Roman Khassraf63444962015-07-13 13:42:57 +0200116 d_prepend_frame_count = prepend_frame_count;
117 d_print_payload_only = print_payload_only;
piotr6c692872014-02-08 14:16:26 +0100118 message_port_register_in(pmt::mp("bursts"));
119 set_msg_handler(pmt::mp("bursts"), boost::bind(&bursts_printer_impl::bursts_print, this, _1));
120 }
Martin Jesper Low Madsenaf769642015-04-28 22:33:43 +0200121
piotr6c692872014-02-08 14:16:26 +0100122 /*
123 * Our virtual destructor.
124 */
125 bursts_printer_impl::~bursts_printer_impl()
126 {
127 }
128
129
130 } /* namespace gsm */
131} /* namespace gr */