Changed code to use C++ functions, and select Panging Requests starting from message type byte - the effect will be probably shorter and easier to read code.

This commit is contained in:
ptrkrysik 2015-01-18 09:56:26 +01:00
parent bdc7a2dd76
commit 03da5c6b2a
2 changed files with 156 additions and 345 deletions

View File

@ -2,22 +2,22 @@
/* @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
@ -27,353 +27,159 @@
#include <gnuradio/io_signature.h>
#include "tmsi_dumper_impl.h"
#include "grgsm/gsmtap.h"
#include <stdio.h>
#include <ctime>
FILE* tmsiFile;
#include <iostream>
#include <boost/format.hpp>
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);
namespace gsm {
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;
}
void tmsi_dumper_impl::dump_tmsi(pmt::pmt_t msg)
{
time_t t = time(0);
tm *now = localtime(&t);
tmsi_dumper::sptr
tmsi_dumper::make()
{
return gnuradio::get_initial_sptr
(new tmsi_dumper_impl());
}
pmt::pmt_t message_plus_header_blob = pmt::cdr(msg);
uint8_t * message_plus_header = (uint8_t *)pmt::blob_data(message_plus_header_blob);
gsmtap_hdr * header = (gsmtap_hdr *)message_plus_header;
uint8_t * m = (uint8_t *)(message_plus_header+sizeof(gsmtap_hdr)); //message content
/*
* 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));
}
uint8_t msg_len = m[0];
uint8_t direction_and_protocol = m[1];
uint8_t msg_type = m[2];
/*
* Our virtual destructor.
*/
tmsi_dumper_impl::~tmsi_dumper_impl()
if( direction_and_protocol == 0x06 && //direction from originating site, transaction id==0, Radio Resouce Management protocol
(msg_type==0x21 || msg_type==0x22 || msg_type==0x24) //types corresponding to paging requests
)
{
switch(msg_type) {
case 0x21: //Paging Request Type 1
{
uint8_t mobile_identity_type = m[5] & 0x07;
unsigned int next_element = 0; //position of the next element
bool found_id_element = false;
if(mobile_identity_type == 0x04) //identity type: TMSI
{
write_tmsi(m+6);
dump_file << "-";
write_timestamp(now);
dump_file << "-0";
dump_file << std::endl;
next_element = 10;
found_id_element = true;
} else
if(mobile_identity_type == 0x01) //identity type: IMSI
{
dump_file << "0-";
write_timestamp(now);
dump_file << "-";
write_imsi(m+5);
dump_file << std::endl;
next_element = 13;
found_id_element = true;
}
if(found_id_element == true)
{
//check if there is additional id element
uint8_t element_id = m[next_element];
if((next_element < (msg_len+1)) && (element_id == 0x17)){
uint8_t element_len = m[next_element+1];
mobile_identity_type = m[next_element+2] & 0x07;
if(mobile_identity_type == 0x04) //identity type: TMSI
{
write_tmsi(m+next_element+3); //write starting from position of the TMSI in the message
dump_file << "-";
write_timestamp(now);
dump_file << "-0";
dump_file << std::endl;
} else
if(mobile_identity_type == 0x01) //identity type: IMSI
{
dump_file << "0-";
write_timestamp(now);
dump_file << "-";
write_imsi(m+next_element+2); //write starting from position of the IMSI in the message
dump_file << std::endl;
}
}
int ii;
}
}
break;
case 0x22: //Paging Request Type 2
break;
case 0x24: //Paging Request Type 3
break;
}
}
} /* namespace gsm */
}
inline void tmsi_dumper_impl::write_timestamp(tm * now)
{
dump_file << boost::format("%d%02d%02d%02d%02d%02d")
% (now->tm_year + 1900) //year
% (now->tm_mon + 1) //month
% now->tm_mday //day
% now->tm_hour % now->tm_min % now->tm_sec; //time of day
return;
}
inline int swap(uint8_t c)
{
uint8_t temp1, temp2;
temp1 = c & 0x0F;
temp2 = c & 0xF0;
temp1=temp1 << 4;
temp2=temp2 >> 4;
return(temp2|temp1);
}
void tmsi_dumper_impl::write_imsi(uint8_t * imsi)
{
dump_file << boost::format("%1x%02x%02x%02x%02x%02x%02x%02x")
% (swap(imsi[0]) & 0x0f)
% swap(imsi[1]) % swap(imsi[2]) % swap(imsi[3]) % swap(imsi[4]) % swap(imsi[5]) % swap(imsi[6]) % swap(imsi[7]);
return;
}
void tmsi_dumper_impl::write_tmsi(uint8_t * tmsi)
{
dump_file << boost::format("%02x%02x%02x%02x")
% (int)tmsi[0] % (int)tmsi[1] % (int)tmsi[2] % (int)tmsi[3];
return;
}
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))
{
dump_file.open("tmsicount.txt", std::ios_base::out);
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()
{
dump_file.close();
}
} /* namespace gsm */
} /* namespace gr */

View File

@ -24,6 +24,8 @@
#define INCLUDED_GSM_TMSI_DUMPER_IMPL_H
#include <grgsm/misc_utils/tmsi_dumper.h>
#include <fstream>
#include <ctime>
namespace gr {
namespace gsm {
@ -31,8 +33,11 @@ namespace gr {
class tmsi_dumper_impl : public tmsi_dumper
{
private:
std::ofstream dump_file;
void dump_tmsi(pmt::pmt_t msg);
void write_timestamp(tm * now);
void write_imsi(uint8_t * imsi);
void write_tmsi(uint8_t * tmsi);
public:
tmsi_dumper_impl();
~tmsi_dumper_impl();