Added packet uplink and downlink assignment, packet uplink ack, RLC/MAC Data and Control blocks dispatchers, gsmtap support for LLC PDUs.
This commit is contained in:
parent
8aa4c52d2e
commit
3450640624
265
GPRSSocket.cpp
265
GPRSSocket.cpp
|
@ -20,8 +20,8 @@
|
|||
#include <Sockets.h>
|
||||
#include <Threads.h>
|
||||
#include <BitVector.h>
|
||||
#include <gsmtap.h>
|
||||
#include "GPRSSocket.h"
|
||||
#include "gsm_rlcmac.h"
|
||||
#include "bssgp.h"
|
||||
|
||||
#define MAX_UDP_LENGTH 1500
|
||||
|
@ -31,6 +31,42 @@
|
|||
|
||||
// TODO: We should take ports and IP from config.
|
||||
UDPSocket GPRSRLCMACSocket(5070, "127.0.0.1", 5934);
|
||||
UDPSocket GSMTAPSocket(5077, "127.0.0.1", 4729);
|
||||
|
||||
void sendToGSMTAP(uint8_t * data, unsigned len)
|
||||
{
|
||||
char buffer[MAX_UDP_LENGTH];
|
||||
int ofs = 0;
|
||||
|
||||
// Build header
|
||||
struct gsmtap_hdr *header = (struct gsmtap_hdr *)buffer;
|
||||
header->version = 2;
|
||||
header->hdr_len = sizeof(struct gsmtap_hdr) >> 2;
|
||||
header->type = 0x08;
|
||||
header->timeslot = 5;
|
||||
header->arfcn = 0;
|
||||
header->signal_dbm = 0;
|
||||
header->snr_db = 0;
|
||||
header->frame_number = 0;
|
||||
header->sub_type = 0;
|
||||
header->antenna_nr = 0;
|
||||
header->sub_slot = 0;
|
||||
header->res = 0;
|
||||
|
||||
ofs += sizeof(*header);
|
||||
|
||||
// Add frame data
|
||||
unsigned j = 0;
|
||||
for (unsigned i = ofs; i < len+ofs; i++)
|
||||
{
|
||||
buffer[i] = (char)data[j];
|
||||
j++;
|
||||
}
|
||||
ofs += len;
|
||||
// Write the GSMTAP packet
|
||||
GSMTAPSocket.write(buffer, ofs);
|
||||
}
|
||||
|
||||
|
||||
void sendToOpenBTS(BitVector * vector)
|
||||
{
|
||||
|
@ -98,6 +134,76 @@ void writePDassignment(BitVector * dest, uint8_t TFI, uint32_t TLLI)
|
|||
dest->writeField(wp,0x0,1); // Measurement Mapping struct not present
|
||||
}
|
||||
|
||||
void writePUassignment(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,0xa,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); // CHANNEL_CODING_COMMAND
|
||||
dest->writeField(wp,0x0,1); // TLLI_BLOCK_CHANNEL_CODING
|
||||
|
||||
dest->writeField(wp,0x1,1); // switch TIMING_ADVANCE_VALUE = on
|
||||
dest->writeField(wp,0x0,6); // TIMING_ADVANCE_VALUE
|
||||
dest->writeField(wp,0x0,1); // switch TIMING_ADVANCE_INDEX = off
|
||||
|
||||
dest->writeField(wp,0x0,1); // Frequency Parameters = off
|
||||
|
||||
dest->writeField(wp,0x1,2); // Dynamic Allocation = off
|
||||
|
||||
dest->writeField(wp,0x0,1); // Dynamic Allocation
|
||||
dest->writeField(wp,0x0,1); // P0 = off
|
||||
|
||||
dest->writeField(wp,0x1,1); // USF_GRANULARITY
|
||||
dest->writeField(wp,0x1,1); // switch TFI : on
|
||||
dest->writeField(wp,TFI,5);// TFI
|
||||
|
||||
dest->writeField(wp,0x0,1); //
|
||||
dest->writeField(wp,0x0,1); // TBF Starting Time = off
|
||||
dest->writeField(wp,0x0,1); // Timeslot Allocation
|
||||
|
||||
dest->writeField(wp,0x0,5); // USF_TN 0 - 4
|
||||
dest->writeField(wp,0x1,1); // USF_TN 5
|
||||
dest->writeField(wp,0x1,3); // USF_TN 5
|
||||
dest->writeField(wp,0x0,2); // USF_TN 6 - 7
|
||||
// dest->writeField(wp,0x0,1); // Measurement Mapping struct not present
|
||||
}
|
||||
|
||||
void writeIARestOctetsDownlinkAssignment(BitVector * dest, uint8_t TFI, uint32_t TLLI)
|
||||
{
|
||||
// GMS 04.08 10.5.2.37b 10.5.2.16
|
||||
unsigned wp = 0;
|
||||
dest->writeField(wp, 3, 2); // "HH"
|
||||
dest->writeField(wp, 1, 2); // "01" Packet Downlink Assignment
|
||||
dest->writeField(wp,TLLI,32); // TLLI
|
||||
dest->writeField(wp,0x1,1); // switch TFI : on
|
||||
dest->writeField(wp,TFI,5); // TFI
|
||||
dest->writeField(wp,0x0,1); // RLC acknowledged mode
|
||||
dest->writeField(wp,0x0,1); // ALPHA = present
|
||||
//dest->writeField(wp,0x0,4); // ALPHA power control parameter
|
||||
dest->writeField(wp,0x0,5); // GAMMA power control parameter
|
||||
dest->writeField(wp,0x1,1); // Polling Bit
|
||||
dest->writeField(wp,0x1,1); // TA_VALID ???
|
||||
dest->writeField(wp,0x1,1); // switch TIMING_ADVANCE_INDEX = on
|
||||
dest->writeField(wp,0xC,4); // TIMING_ADVANCE_INDEX
|
||||
dest->writeField(wp,0x1,1); // TBF Starting TIME present
|
||||
dest->writeField(wp,0xffff,16); // TBF Starting TIME (we should set it in OpenBTS)
|
||||
dest->writeField(wp,0x0,1); // P0 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.
|
||||
|
@ -137,56 +243,41 @@ void writePUack(BitVector * dest, uint8_t TFI, uint32_t TLLI, unsigned CV, unsig
|
|||
dest->writeField(wp,0x00,4); //spare
|
||||
}
|
||||
|
||||
void RLCMACDispatchMessage(BitVector *vector)
|
||||
void RLCMACExtractData(uint8_t* tfi, uint32_t* tlli, RlcMacUplinkDataBlock_t * dataBlock, uint8_t* rlc_data, unsigned* dataIndex)
|
||||
{
|
||||
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);
|
||||
unsigned dataOctetNum = 0;
|
||||
|
||||
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;
|
||||
*tfi = dataBlock->TFI;
|
||||
if (dataBlock->E_1 == 0) // Extension octet follows immediately
|
||||
{
|
||||
// TODO We should implement case with several LLC PDU in one data block.
|
||||
blockDataLen = dataBlock->LENGTH_INDICATOR[0];
|
||||
}
|
||||
else
|
||||
{
|
||||
blockDataLen = 20;
|
||||
blockDataLen = 20; // RLC data length without 3 header octets.
|
||||
if(dataBlock->TI == 1) // TLLI field is present
|
||||
{
|
||||
tlli = dataBlock->TLLI;
|
||||
blockDataLen -= 4;
|
||||
*tlli = dataBlock->TLLI;
|
||||
blockDataLen -= 4; // TLLI length
|
||||
if (dataBlock->PI == 1) // PFI is present if TI field indicates presence of TLLI
|
||||
{
|
||||
blockDataLen -= 1;
|
||||
blockDataLen -= 1; // PFI length
|
||||
}
|
||||
}
|
||||
}
|
||||
unsigned dataOctetNum = 0;
|
||||
for (unsigned i = dataIndex; i < dataIndex + blockDataLen; i++)
|
||||
|
||||
for (unsigned i = *dataIndex; i < *dataIndex + blockDataLen; i++)
|
||||
{
|
||||
rlc_data[i] = dataBlock->RLC_DATA[dataOctetNum];
|
||||
dataOctetNum++;
|
||||
}
|
||||
dataIndex += blockDataLen;
|
||||
*dataIndex += blockDataLen;
|
||||
}
|
||||
|
||||
void sendUplinkAck(uint8_t tfi, uint32_t tlli, RlcMacUplinkDataBlock_t * dataBlock)
|
||||
{
|
||||
BitVector packetUplinkAck(23*8);
|
||||
packetUplinkAck.unhex("2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
|
||||
writePUack(&packetUplinkAck, tfi, tlli, dataBlock->CV, dataBlock->BSN);
|
||||
|
@ -196,25 +287,119 @@ void RLCMACDispatchMessage(BitVector *vector)
|
|||
free(pUA);
|
||||
COUT("RLCMAC_CONTROL_BLOCK_END------------------------------");
|
||||
sendToOpenBTS(&packetUplinkAck);
|
||||
}
|
||||
if (dataBlock->CV == 0)
|
||||
}
|
||||
|
||||
void RLCMACDispatchDataBlock(unsigned* waitData, BitVector *vector, uint8_t* tfi, uint32_t* tlli, uint8_t* rlc_data, unsigned* dataIndex)
|
||||
{
|
||||
static DataBlockDispatcherState state = WaitSequenceStart;
|
||||
static unsigned prevBSN = -1;
|
||||
if ((*waitData == 1)&&(state == WaitNextSequence))
|
||||
{
|
||||
sendToSGSN(tfi, tlli, rlc_data, dataIndex);
|
||||
dataIndex = 0;
|
||||
startDispatch = 0;
|
||||
state = WaitSequenceStart;
|
||||
}
|
||||
free(dataBlock);
|
||||
|
||||
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------------------------------");
|
||||
|
||||
switch (state) {
|
||||
case WaitSequenceStart:
|
||||
if (dataBlock->BSN == 0)
|
||||
{
|
||||
*dataIndex = 0;
|
||||
RLCMACExtractData(tfi, tlli, dataBlock, rlc_data, dataIndex);
|
||||
sendUplinkAck(*tfi, *tlli, dataBlock);
|
||||
state = WaitNextBlock;
|
||||
prevBSN = 0;
|
||||
}
|
||||
break;
|
||||
case RLCMAC_CONTROL_BLOCK:
|
||||
case WaitNextBlock:
|
||||
if (prevBSN == (dataBlock->BSN - 1))
|
||||
{
|
||||
RLCMACExtractData(tfi, tlli, dataBlock, rlc_data, dataIndex);
|
||||
sendUplinkAck(*tfi, *tlli, dataBlock);
|
||||
if (dataBlock->CV == 0)
|
||||
{
|
||||
// Recieved last Data Block in this sequence.
|
||||
sendToGSMTAP(rlc_data, *dataIndex);
|
||||
state = WaitNextSequence;
|
||||
prevBSN = -1;
|
||||
*waitData = 0;
|
||||
}
|
||||
else
|
||||
{
|
||||
prevBSN = dataBlock->BSN;
|
||||
state = WaitNextBlock;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
// Recieved Data Block with unexpected BSN.
|
||||
// We should try to find nesessary Data Block.
|
||||
state = WaitNextBlock;
|
||||
}
|
||||
break;
|
||||
case WaitNextSequence:
|
||||
// Now we just ignore all Data Blocks and wait next Uplink TBF
|
||||
break;
|
||||
}
|
||||
free(dataBlock);
|
||||
}
|
||||
|
||||
void RLCMACDispatchControlBlock(unsigned* waitData, BitVector *vector, uint8_t* tfi, uint32_t* tlli, uint8_t* rlc_data, unsigned* dataIndex)
|
||||
{
|
||||
static unsigned shutUp = 0;
|
||||
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------------------------------");
|
||||
switch (controlBlock->u.MESSAGE_TYPE) {
|
||||
case MT_PACKET_CONTROL_ACK:
|
||||
if (shutUp == 0)
|
||||
{
|
||||
COUT("SEND IA Rest Octets Downlink Assignment>>>>>>>>>>>>>>>>>>");
|
||||
BitVector IARestOctetsDownlinkAssignment(23*8);
|
||||
IARestOctetsDownlinkAssignment.unhex("2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
|
||||
writeIARestOctetsDownlinkAssignment(&IARestOctetsDownlinkAssignment, 20, *tlli);
|
||||
sendToOpenBTS(&IARestOctetsDownlinkAssignment);
|
||||
usleep(500000);
|
||||
sendToSGSN(*tfi, *tlli, rlc_data, *dataIndex);
|
||||
//sendToGSMTAP(rlc_data, *dataIndex);
|
||||
shutUp = 1;
|
||||
}
|
||||
break;
|
||||
case MT_PACKET_DOWNLINK_ACK_NACK:
|
||||
COUT("SEND PacketUplinkAssignment>>>>>>>>>>>>>>>>>>");
|
||||
BitVector PacketUplinkAssignment(23*8);
|
||||
PacketUplinkAssignment.unhex("2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b2b");
|
||||
writePUassignment(&PacketUplinkAssignment, 21, *tlli);
|
||||
sendToOpenBTS(&PacketUplinkAssignment);
|
||||
*waitData = 1;
|
||||
break;
|
||||
}
|
||||
free(controlBlock);
|
||||
|
||||
}
|
||||
|
||||
void RLCMACDispatchBlock(BitVector *vector)
|
||||
{
|
||||
static uint8_t rlc_data[60];
|
||||
static uint8_t *tfi = (uint8_t *)malloc(sizeof(uint8_t));
|
||||
static uint32_t *tlli = (uint32_t *)malloc(sizeof(uint32_t));
|
||||
static unsigned *dataIndex = (unsigned *)malloc(sizeof(unsigned));
|
||||
static unsigned waitData = 1;
|
||||
|
||||
unsigned readIndex = 0;
|
||||
unsigned payload = vector->readField(readIndex, 2);
|
||||
|
||||
switch (payload) {
|
||||
case RLCMAC_DATA_BLOCK:
|
||||
RLCMACDispatchDataBlock(&waitData,vector, tfi, tlli, rlc_data, dataIndex);
|
||||
break;
|
||||
case RLCMAC_CONTROL_BLOCK:
|
||||
RLCMACDispatchControlBlock(&waitData, vector, tfi, tlli, rlc_data, dataIndex);
|
||||
break;
|
||||
default:
|
||||
COUT("Unknown RLCMAC block payload\n");
|
||||
}
|
||||
|
@ -230,7 +415,7 @@ void *RLCMACSocket(void *)
|
|||
if (count>0) {
|
||||
vector->unpack((const unsigned char*)buf);
|
||||
COUT("Recieve from OpenBTS (MS): " << *vector);
|
||||
RLCMACDispatchMessage(vector);
|
||||
RLCMACDispatchBlock(vector);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
|
18
GPRSSocket.h
18
GPRSSocket.h
|
@ -21,12 +21,28 @@
|
|||
#define GPRSSOCKET_H
|
||||
|
||||
#include <BitVector.h>
|
||||
#include "gsm_rlcmac.h"
|
||||
|
||||
|
||||
enum DataBlockDispatcherState {
|
||||
WaitSequenceStart,
|
||||
WaitNextBlock,
|
||||
WaitNextSequence
|
||||
};
|
||||
|
||||
void sendToGSMTAP(uint8_t * data, unsigned len);
|
||||
|
||||
void sendToOpenBTS(BitVector * vector);
|
||||
|
||||
void writePUack(BitVector * dest, uint8_t TFI, uint32_t TLLI, unsigned CV, unsigned BSN);
|
||||
|
||||
void RLCMACDispatchMessage(BitVector *vector);
|
||||
void RLCMACExtractData(uint8_t* tfi, uint32_t* tlli, RlcMacUplinkDataBlock_t * dataBlock, uint8_t* rlc_data, unsigned* dataIndex);
|
||||
|
||||
void sendUplinkAck(uint8_t tfi, uint32_t tlli, RlcMacUplinkDataBlock_t * dataBlock);
|
||||
|
||||
void RLCMACDispatchDataBlock(BitVector *vector, uint8_t* tfi, uint32_t* tlli, uint8_t* rlc_data, unsigned* dataIndex);
|
||||
|
||||
void RLCMACDispatchBlock(BitVector *vector);
|
||||
|
||||
void *RLCMACSocket(void *);
|
||||
|
||||
|
|
Loading…
Reference in New Issue