139 lines
3.4 KiB
C++
139 lines
3.4 KiB
C++
/*
|
|
* Copyright 2008, 2009 Free Software Foundation, Inc.
|
|
*
|
|
|
|
This program is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU Affero 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 Affero General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Affero General Public License
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*
|
|
* This use of this software may be subject to additional restrictions.
|
|
* See the LEGAL file in the main directory for details.
|
|
|
|
* This software is distributed under the terms of the GNU Affero Public License.
|
|
* See the COPYING file in the main directory for details.
|
|
*/
|
|
|
|
|
|
#include "GSMTAPDump.h"
|
|
#include "GSMTransfer.h"
|
|
#include <Sockets.h>
|
|
#include <Globals.h>
|
|
|
|
UDPSocket GSMTAPSocket;
|
|
|
|
void gWriteGSMTAP(unsigned ARFCN, unsigned TS, unsigned FN,
|
|
GSM::TypeAndOffset to, bool is_saach, bool ul_dln,
|
|
const BitVector& frame)
|
|
{
|
|
char buffer[MAX_UDP_LENGTH];
|
|
int ofs = 0;
|
|
|
|
// Check if GSMTap is enabled
|
|
if (!gConfig.defines("GSMTAP.TargetIP")) return;
|
|
|
|
// Port configuration
|
|
unsigned port = GSMTAP_UDP_PORT; // default port for GSM-TAP
|
|
if (gConfig.defines("GSMTAP.TargetPort"))
|
|
port = gConfig.getNum("GSMTAP.TargetPort");
|
|
|
|
// Set socket destination
|
|
GSMTAPSocket.destination(port,gConfig.getStr("GSMTAP.TargetIP"));
|
|
|
|
// Decode TypeAndOffset
|
|
uint8_t stype, scn;
|
|
|
|
switch (to) {
|
|
case GSM::TDMA_BEACON_BCCH:
|
|
stype = GSMTAP_CHANNEL_BCCH;
|
|
scn = 0;
|
|
break;
|
|
|
|
case GSM::TDMA_BEACON_CCCH:
|
|
stype = GSMTAP_CHANNEL_CCCH;
|
|
scn = 0;
|
|
break;
|
|
|
|
case GSM::SDCCH_4_0:
|
|
case GSM::SDCCH_4_1:
|
|
case GSM::SDCCH_4_2:
|
|
case GSM::SDCCH_4_3:
|
|
stype = GSMTAP_CHANNEL_SDCCH4;
|
|
scn = to - GSM::SDCCH_4_0;
|
|
break;
|
|
|
|
case GSM::SDCCH_8_0:
|
|
case GSM::SDCCH_8_1:
|
|
case GSM::SDCCH_8_2:
|
|
case GSM::SDCCH_8_3:
|
|
case GSM::SDCCH_8_4:
|
|
case GSM::SDCCH_8_5:
|
|
case GSM::SDCCH_8_6:
|
|
case GSM::SDCCH_8_7:
|
|
stype = GSMTAP_CHANNEL_SDCCH8;
|
|
scn = to - GSM::SDCCH_8_0;
|
|
break;
|
|
|
|
case GSM::TCHF_0:
|
|
stype = GSMTAP_CHANNEL_TCH_F;
|
|
scn = 0;
|
|
break;
|
|
|
|
case GSM::TCHH_0:
|
|
case GSM::TCHH_1:
|
|
stype = GSMTAP_CHANNEL_TCH_H;
|
|
scn = to - GSM::TCHH_0;
|
|
break;
|
|
|
|
default:
|
|
stype = GSMTAP_CHANNEL_UNKNOWN;
|
|
scn = 0;
|
|
}
|
|
|
|
if (is_saach)
|
|
stype |= GSMTAP_CHANNEL_ACCH;
|
|
|
|
// Flags in ARFCN
|
|
if (gConfig.getNum("GSM.Band") == 1900)
|
|
ARFCN |= GSMTAP_ARFCN_F_PCS;
|
|
|
|
if (ul_dln)
|
|
ARFCN |= GSMTAP_ARFCN_F_UPLINK;
|
|
|
|
// Build header
|
|
struct gsmtap_hdr *header = (struct gsmtap_hdr *)buffer;
|
|
header->version = GSMTAP_VERSION;
|
|
header->hdr_len = sizeof(struct gsmtap_hdr) >> 2;
|
|
header->type = GSMTAP_TYPE_UM;
|
|
header->timeslot = TS;
|
|
header->arfcn = htons(ARFCN);
|
|
header->signal_dbm = 0; /* FIXME */
|
|
header->snr_db = 0; /* FIXME */
|
|
header->frame_number = htonl(FN);
|
|
header->sub_type = stype;
|
|
header->antenna_nr = 0;
|
|
header->sub_slot = scn;
|
|
header->res = 0;
|
|
|
|
ofs += sizeof(*header);
|
|
|
|
// Add frame data
|
|
frame.pack((unsigned char*)&buffer[ofs]);
|
|
ofs += (frame.size() + 7) >> 3;
|
|
|
|
// Write the GSMTAP packet
|
|
GSMTAPSocket.write(buffer, ofs);
|
|
}
|
|
|
|
|
|
|
|
// vim: ts=4 sw=4
|