Gitiles
Code Review Sign In
gerrit.osmocom.org / gr-gsm / 6f27bcffcc49dfb6ecef23d01cd6dce9a7988206 / . / lib / misc_utils / tmsi_dumper_impl.cc
blob: 10f06fe19050dac59a07ccc2f75d3c64ad130279 [file] [log] [blame]
/* -*- c++ -*- */
/* @file
* @author Piotr Krysik <ptrkrysik@gmail.com>
* @section LICENSE
*
* Gr-gsm 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, or (at your option)
* any later version.
*
* Gr-gsm 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 gr-gsm; see the file COPYING. If not, write to
* the Free Software Foundation, Inc., 51 Franklin Street,
* Boston, MA 02110-1301, USA.
*
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <gnuradio/io_signature.h>
#include "tmsi_dumper_impl.h"
#include "grgsm/gsmtap.h"
#include <stdio.h>
#include <ctime>
FILE* tmsiFile;
namespace gr {
namespace gsm {
void tmsi_dumper_impl::dump_tmsi(pmt::pmt_t msg)
{
time_t now = time(0);
tm *ltm = localtime(&now);
pmt::pmt_t message_plus_header_blob = pmt::cdr(msg);
uint8_t * message_plus_header = (uint8_t *)pmt::blob_data(message_plus_header_blob);
size_t message_plus_header_len=pmt::blob_length(message_plus_header_blob);
gsmtap_hdr * header = (gsmtap_hdr *)message_plus_header;
int ii=sizeof(gsmtap_hdr);
switch(message_plus_header[ii]){
case 37:
//1 tmsi 6-9
if((unsigned char)message_plus_header[ii+1] == 6 && (unsigned char)message_plus_header[ii+2] == 33)
{
if((unsigned char)message_plus_header[ii+6] != 43 && (unsigned char)message_plus_header[ii+6] != 43)
{
//printf("INSIDE 37\n");
tmsiFile = fopen("tmsicount.txt", "a+");
fprintf(tmsiFile,"%02.2x%02.2x%02.2x%02.2x-%02i%02i%02i%02i%02i%02i-%i\n",
(unsigned char)message_plus_header[ii+6],
(unsigned char)message_plus_header[ii+7],
(unsigned char)message_plus_header[ii+8],
(unsigned char)message_plus_header[ii+9],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,
0);
fclose(tmsiFile);
}
}
break;
case 49:
if(message_plus_header[ii+2] == 33)//21 hex
{
//printf("INSIDE 49\n");
//1 imsi 5-12 33
tmsiFile = fopen("tmsicount.txt", "a");
fprintf(tmsiFile,"%i-%02i%02i%02i%02i%02i%02i-%02.2x%02.2x%02.2x%02.2x%02.2x%02.2x%02.2x%02.2x\n",0,
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,
(unsigned char)message_plus_header[ii+5],
(unsigned char)message_plus_header[ii+6],
(unsigned char)message_plus_header[ii+7],
(unsigned char)message_plus_header[ii+8],
(unsigned char)message_plus_header[ii+9],
(unsigned char)message_plus_header[ii+10],
(unsigned char)message_plus_header[ii+11],
(unsigned char)message_plus_header[ii+12]);
fclose(tmsiFile);
}
break;
case 65:
//printf("INSIDE 65\n"); (41 hex) (65 int) 6-8 13-16
if(message_plus_header[ii+2] == 33)//21 hex
{
tmsiFile = fopen("tmsicount.txt", "a+");
fprintf(tmsiFile,"%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n",
(unsigned char)message_plus_header[ii+6],
(unsigned char)message_plus_header[ii+7],
(unsigned char)message_plus_header[ii+8],
(unsigned char)message_plus_header[ii+9],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0,
(unsigned char)message_plus_header[ii+13],
(unsigned char)message_plus_header[ii+14],
(unsigned char)message_plus_header[ii+15],
(unsigned char)message_plus_header[ii+16],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0);
fclose(tmsiFile);
}
break;
case 73:
//printf("INSIDE 73\n");
//3 tmsi 4-7 8-11 15-18
if(message_plus_header[ii+2] == 34)
{
tmsiFile = fopen("tmsicount.txt", "a+");
fprintf(tmsiFile,"%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n",
(unsigned char)message_plus_header[ii+4],
(unsigned char)message_plus_header[ii+5],
(unsigned char)message_plus_header[ii+6],
(unsigned char)message_plus_header[ii+7],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0,
(unsigned char)message_plus_header[ii+8],
(unsigned char)message_plus_header[ii+9],
(unsigned char)message_plus_header[ii+10],
(unsigned char)message_plus_header[ii+11],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0,
(unsigned char)message_plus_header[ii+15],
(unsigned char)message_plus_header[ii+16],
(unsigned char)message_plus_header[ii+17],
(unsigned char)message_plus_header[ii+18],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0);
fclose(tmsiFile);
}
break;
case 77:
if(message_plus_header[ii+2] == 33 && message_plus_header[ii+4] == 8)
{
//1 imsi 1 tmsi 5-12 16-19
//printf("INSIDE 77 + 33 + 8\n");
tmsiFile = fopen("tmsicount.txt", "a+");
fprintf(tmsiFile,"%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%02.2x%02.2x%02.2x%02.2x%02.2x%02.2x%02.2x%02.2x\n",
(unsigned char)message_plus_header[ii+16],
(unsigned char)message_plus_header[ii+17],
(unsigned char)message_plus_header[ii+18],
(unsigned char)message_plus_header[ii+19],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,
(unsigned char)message_plus_header[ii+5],
(unsigned char)message_plus_header[ii+6],
(unsigned char)message_plus_header[ii+7],
(unsigned char)message_plus_header[ii+8],
(unsigned char)message_plus_header[ii+9],
(unsigned char)message_plus_header[ii+10],
(unsigned char)message_plus_header[ii+11],
(unsigned char)message_plus_header[ii+12]);
fclose(tmsiFile);
}
else if(message_plus_header[ii+2] == 33 && message_plus_header[ii+4] == 5)
{
//1 tmsi 1 imsi 6-9 12-19
//printf("INSIDE 77 + 33 + 5\n");
tmsiFile = fopen("tmsicount.txt", "a+");
fprintf(tmsiFile,"%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%02.2x%02.2x%02.2x%02.2x%02.2x%02.2x%02.2x%02.2x\n",
(unsigned char)message_plus_header[ii+6],
(unsigned char)message_plus_header[ii+7],
(unsigned char)message_plus_header[ii+8],
(unsigned char)message_plus_header[ii+9],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,
(unsigned char)message_plus_header[ii+12],
(unsigned char)message_plus_header[ii+13],
(unsigned char)message_plus_header[ii+14],
(unsigned char)message_plus_header[ii+15],
(unsigned char)message_plus_header[ii+16],
(unsigned char)message_plus_header[ii+17],
(unsigned char)message_plus_header[ii+18],
(unsigned char)message_plus_header[ii+19]);
fclose(tmsiFile);
}
else if(message_plus_header[ii+2] == 34)
{
//printf("INSIDE 77 + 34\n");
tmsiFile = fopen("tmsicount.txt", "a+");
fprintf(tmsiFile,"%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n",
(unsigned char)message_plus_header[ii+4],
(unsigned char)message_plus_header[ii+5],
(unsigned char)message_plus_header[ii+6],
(unsigned char)message_plus_header[ii+7],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0,
(unsigned char)message_plus_header[ii+8],
(unsigned char)message_plus_header[ii+9],
(unsigned char)message_plus_header[ii+10],
(unsigned char)message_plus_header[ii+11],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0,
(unsigned char)message_plus_header[ii+15],
(unsigned char)message_plus_header[ii+16],
(unsigned char)message_plus_header[ii+17],
(unsigned char)message_plus_header[ii+18],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0);
fclose(tmsiFile);
}
else if(message_plus_header[ii+2] == 36)
{
//printf("INSIDE 77 + 36\n");
tmsiFile = fopen("tmsicount.txt", "a+");
fprintf(tmsiFile,"%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n",
(unsigned char)message_plus_header[ii+4],
(unsigned char)message_plus_header[ii+5],
(unsigned char)message_plus_header[ii+6],
(unsigned char)message_plus_header[ii+7],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0,
(unsigned char)message_plus_header[ii+8],
(unsigned char)message_plus_header[ii+9],
(unsigned char)message_plus_header[ii+10],
(unsigned char)message_plus_header[ii+11],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0,
(unsigned char)message_plus_header[ii+12],
(unsigned char)message_plus_header[ii+13],
(unsigned char)message_plus_header[ii+14],
(unsigned char)message_plus_header[ii+15],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0,
(unsigned char)message_plus_header[ii+16],
(unsigned char)message_plus_header[ii+17],
(unsigned char)message_plus_header[ii+18],
(unsigned char)message_plus_header[ii+19],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0);
fclose(tmsiFile);
}
break;
case 85:
if(message_plus_header[ii+2] == 34)//hex 22
{
//printf("INSIDE 85\n");// hex is 55
tmsiFile = fopen("tmsicount.txt", "a+");
fprintf(tmsiFile,"%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n%02.2x%02.2x%02.2x%02.2x-%02d%02d%02d%02d%02d%02d-%i\n",
(unsigned char)message_plus_header[ii+4],
(unsigned char)message_plus_header[ii+5],
(unsigned char)message_plus_header[ii+6],
(unsigned char)message_plus_header[ii+7],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0,
(unsigned char)message_plus_header[ii+8],
(unsigned char)message_plus_header[ii+9],
(unsigned char)message_plus_header[ii+10],
(unsigned char)message_plus_header[ii+11],
1900 + ltm->tm_year-2000,
1+ltm->tm_mon,
ltm->tm_mday,
ltm->tm_hour,
ltm->tm_min,
ltm->tm_sec,0);
fclose(tmsiFile);
}
break;
}
std::cout << std::endl;
}
tmsi_dumper::sptr
tmsi_dumper::make()
{
return gnuradio::get_initial_sptr
(new tmsi_dumper_impl());
}
/*
* The private constructor
*/
tmsi_dumper_impl::tmsi_dumper_impl()
: gr::block("tmsi_dumper",
gr::io_signature::make(0, 0, 0),
gr::io_signature::make(0, 0, 0))
{
message_port_register_in(pmt::mp("msgs"));
set_msg_handler(pmt::mp("msgs"), boost::bind(&tmsi_dumper_impl::dump_tmsi, this, _1));
}
/*
* Our virtual destructor.
*/
tmsi_dumper_impl::~tmsi_dumper_impl()
{
}
} /* namespace gsm */
} /* namespace gr */