237 lines
8.0 KiB
C++
237 lines
8.0 KiB
C++
/*GPRSSocket.cpp
|
|
*
|
|
* Copyright (C) 2011 Ivan Klyuchnikov
|
|
*
|
|
* This program 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 2
|
|
* 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 General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
*/
|
|
|
|
#include <Sockets.h>
|
|
#include <Threads.h>
|
|
#include <BitVector.h>
|
|
#include "GPRSSocket.h"
|
|
#include "gsm_rlcmac.h"
|
|
#include "bssgp.h"
|
|
|
|
#define MAX_UDP_LENGTH 1500
|
|
|
|
#define RLCMAC_DATA_BLOCK 0
|
|
#define RLCMAC_CONTROL_BLOCK 1
|
|
|
|
// TODO: We should take ports and IP from config.
|
|
UDPSocket GPRSRLCMACSocket(5070, "127.0.0.1", 5934);
|
|
|
|
void sendToOpenBTS(BitVector * vector)
|
|
{
|
|
char buffer[MAX_UDP_LENGTH];
|
|
int ofs = 0;
|
|
vector->pack((unsigned char*)&buffer[ofs]);
|
|
ofs += vector->size() >> 3;
|
|
COUT("Send to OpenBTS: " << *vector);
|
|
GPRSRLCMACSocket.write(buffer, ofs);
|
|
}
|
|
|
|
void writePDassignment(BitVector * dest, uint8_t TFI, uint32_t TLLI)
|
|
{
|
|
// TODO We should use our implementation of encode RLC/MAC Control messages.
|
|
unsigned wp = 0;
|
|
dest->writeField(wp,0x1,2); // Payload Type
|
|
dest->writeField(wp,0x0,2); // Uplink block with TDMA framenumber
|
|
dest->writeField(wp,0x1,1); // Suppl/Polling Bit
|
|
dest->writeField(wp,0x1,3); // Uplink state flag
|
|
dest->writeField(wp,0x2,6); // MESSAGE TYPE
|
|
dest->writeField(wp,0x0,2); // Page Mode
|
|
|
|
dest->writeField(wp,0x0,1); // switch PERSIST_LEVEL: off
|
|
dest->writeField(wp,0x2,2); // switch TLLI : on
|
|
dest->writeField(wp,TLLI,32); // TLLI
|
|
|
|
dest->writeField(wp,0x0,1); // Message escape
|
|
dest->writeField(wp,0x0,2); // Medium Access Method: Dynamic Allocation
|
|
dest->writeField(wp,0x0,1); // RLC acknowledged mode
|
|
|
|
dest->writeField(wp,0x0,1); // the network establishes no new downlink TBF for the mobile station
|
|
dest->writeField(wp,0x1,8); // timeslot 7
|
|
dest->writeField(wp,0x1,8); // TIMING_ADVANCE_INDEX
|
|
|
|
dest->writeField(wp,0x0,1); // switch TIMING_ADVANCE_VALUE = off
|
|
dest->writeField(wp,0x1,1); // switch TIMING_ADVANCE_INDEX = on
|
|
dest->writeField(wp,0xC,4); // TIMING_ADVANCE_INDEX
|
|
dest->writeField(wp,0x7,3); // TIMING_ADVANCE_TIMESLOT_NUMBER
|
|
|
|
dest->writeField(wp,0x0,1); // switch POWER CONTROL = off
|
|
dest->writeField(wp,0x1,1); // Frequency Parameters information elements = present
|
|
|
|
dest->writeField(wp,0x2,3); // Training Sequence Code (TSC) = 2
|
|
dest->writeField(wp,0x1,2); // Indirect encoding struct = present
|
|
dest->writeField(wp,0x0,6); // MAIO
|
|
dest->writeField(wp,0xE,4); // MA_Number
|
|
dest->writeField(wp,0x8,4); // CHANGE_MARK_1 CHANGE_MARK_2
|
|
|
|
dest->writeField(wp,0x1,1); // switch TFI : on
|
|
dest->writeField(wp,0x14,5);// TFI
|
|
|
|
dest->writeField(wp,0x1,1); // Power Control Parameters IE = present
|
|
dest->writeField(wp,0x0,4); // ALPHA power control parameter
|
|
dest->writeField(wp,0x0,1); // switch GAMMA_TN0 = off
|
|
dest->writeField(wp,0x0,1); // switch GAMMA_TN1 = off
|
|
dest->writeField(wp,0x0,1); // switch GAMMA_TN2 = off
|
|
dest->writeField(wp,0x0,1); // switch GAMMA_TN3 = off
|
|
dest->writeField(wp,0x0,1); // switch GAMMA_TN4 = off
|
|
dest->writeField(wp,0x0,1); // switch GAMMA_TN5 = off
|
|
dest->writeField(wp,0x0,1); // switch GAMMA_TN6 = off
|
|
dest->writeField(wp,0x1,1); // switch GAMMA_TN7 = on
|
|
dest->writeField(wp,0x0,5); // GAMMA_TN7
|
|
|
|
dest->writeField(wp,0x0,1); // TBF Starting TIME IE not present
|
|
dest->writeField(wp,0x0,1); // Measurement Mapping struct not present
|
|
}
|
|
|
|
void writePUack(BitVector * dest, uint8_t TFI, uint32_t TLLI, unsigned CV, unsigned BSN)
|
|
{
|
|
// TODO We should use our implementation of encode RLC/MAC Control messages.
|
|
unsigned wp = 0;
|
|
dest->writeField(wp,0x1,2); // payload
|
|
dest->writeField(wp,0x0,2); // Uplink block with TDMA framenumber
|
|
if (CV == 0) dest->writeField(wp,0x1,1); // Suppl/Polling Bit
|
|
else dest->writeField(wp,0x0,1); //Suppl/Polling Bit
|
|
dest->writeField(wp,0x1,3); // Uplink state flag
|
|
|
|
//dest->writeField(wp,0x0,1); // Reduced block sequence number
|
|
//dest->writeField(wp,BSN+6,5); // Radio transaction identifier
|
|
//dest->writeField(wp,0x1,1); // Final segment
|
|
//dest->writeField(wp,0x1,1); // Address control
|
|
|
|
//dest->writeField(wp,0x0,2); // Power reduction: 0
|
|
//dest->writeField(wp,TFI,5); // Temporary flow identifier
|
|
//dest->writeField(wp,0x1,1); // Direction
|
|
|
|
dest->writeField(wp,0x09,6); // MESSAGE TYPE
|
|
dest->writeField(wp,0x0,2); // Page Mode
|
|
|
|
dest->writeField(wp,0x0,2);
|
|
dest->writeField(wp,TFI,5); // Uplink TFI
|
|
dest->writeField(wp,0x0,1);
|
|
|
|
dest->writeField(wp,0x0,2); // CS1
|
|
if (CV == 0) dest->writeField(wp,0x1,1); // FINAL_ACK_INDICATION
|
|
else dest->writeField(wp,0x0,1); // FINAL_ACK_INDICATION
|
|
dest->writeField(wp,BSN+1,7); // STARTING_SEQUENCE_NUMBER
|
|
// RECEIVE_BLOCK_BITMAP
|
|
for (unsigned i=0; i<8; i++) {
|
|
dest->writeField(wp,0xff,8);
|
|
}
|
|
dest->writeField(wp,0x1,1); // CONTENTION_RESOLUTION_TLLI = present
|
|
dest->writeField(wp,TLLI,8*4);
|
|
dest->writeField(wp,0x00,4); //spare
|
|
}
|
|
|
|
void RLCMACDispatchMessage(BitVector *vector)
|
|
{
|
|
static uint8_t rlc_data[60];
|
|
static uint8_t tfi = 0;
|
|
static uint32_t tlli = 0;
|
|
static unsigned dataIndex = 0;
|
|
static unsigned startDispatch = 0;
|
|
unsigned blockDataLen = 0;
|
|
unsigned readIndex = 0;
|
|
unsigned payload = vector->readField(readIndex, 2);
|
|
|
|
switch (payload) {
|
|
case RLCMAC_DATA_BLOCK:
|
|
{
|
|
COUT("RLCMAC_DATA_BLOCK<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<");
|
|
RlcMacUplinkDataBlock_t * dataBlock = (RlcMacUplinkDataBlock_t *)malloc(sizeof(RlcMacUplinkDataBlock_t));
|
|
decode_gsm_rlcmac_uplink_data(vector, dataBlock);
|
|
COUT("RLCMAC_DATA_BLOCK_END------------------------------");
|
|
//TODO Implement other cases.
|
|
if (dataBlock->BSN == 0)
|
|
{
|
|
startDispatch = 1;
|
|
}
|
|
if (startDispatch)
|
|
{
|
|
tfi = dataBlock->TFI;
|
|
if (dataBlock->E_1 == 0) // Extension octet follows immediately
|
|
{
|
|
blockDataLen = dataBlock->LENGTH_INDICATOR[0];
|
|
}
|
|
else
|
|
{
|
|
blockDataLen = 20;
|
|
if(dataBlock->TI == 1) // TLLI field is present
|
|
{
|
|
tlli = dataBlock->TLLI;
|
|
blockDataLen -= 4;
|
|
if (dataBlock->PI == 1) // PFI is present if TI field indicates presence of TLLI
|
|
{
|
|
blockDataLen -= 1;
|
|
}
|
|
}
|
|
}
|
|
unsigned dataOctetNum = 0;
|
|
for (unsigned i = dataIndex; i < dataIndex + blockDataLen; i++)
|
|
{
|
|
rlc_data[i] = dataBlock->RLC_DATA[dataOctetNum];
|
|
dataOctetNum++;
|
|
}
|
|
dataIndex += blockDataLen;
|
|
BitVector packetUplinkAck(23*8);
|
|
packetUplinkAck.unhex("2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
|
|
writePUack(&packetUplinkAck, tfi, tlli, dataBlock->CV, dataBlock->BSN);
|
|
COUT("RLCMAC_CONTROL_BLOCK>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>");
|
|
RlcMacDownlink_t * pUA = (RlcMacDownlink_t *)malloc(sizeof(RlcMacUplink_t));
|
|
decode_gsm_rlcmac_downlink(&packetUplinkAck, pUA);
|
|
free(pUA);
|
|
COUT("RLCMAC_CONTROL_BLOCK_END------------------------------");
|
|
sendToOpenBTS(&packetUplinkAck);
|
|
}
|
|
if (dataBlock->CV == 0)
|
|
{
|
|
sendToSGSN(tfi, tlli, rlc_data, dataIndex);
|
|
dataIndex = 0;
|
|
startDispatch = 0;
|
|
}
|
|
free(dataBlock);
|
|
}
|
|
break;
|
|
case RLCMAC_CONTROL_BLOCK:
|
|
{
|
|
COUT("RLCMAC_CONTROL_BLOCK<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<");
|
|
RlcMacUplink_t * controlBlock = (RlcMacUplink_t *)malloc(sizeof(RlcMacUplink_t));
|
|
decode_gsm_rlcmac_uplink(vector, controlBlock);
|
|
free(controlBlock);
|
|
COUT("RLCMAC_CONTROL_BLOCK_END------------------------------");
|
|
}
|
|
break;
|
|
default:
|
|
COUT("Unknown RLCMAC block payload\n");
|
|
}
|
|
}
|
|
|
|
void *RLCMACSocket(void *)
|
|
{
|
|
BitVector *vector = new BitVector(23*8);
|
|
GPRSRLCMACSocket.nonblocking();
|
|
while (1) {
|
|
char buf[MAX_UDP_LENGTH];
|
|
int count = GPRSRLCMACSocket.read(buf, 3000);
|
|
if (count>0) {
|
|
vector->unpack((const unsigned char*)buf);
|
|
COUT("Recieve from OpenBTS (MS): " << *vector);
|
|
RLCMACDispatchMessage(vector);
|
|
}
|
|
}
|
|
}
|