DC_PUSDumpMemoryOffset.cpp

//
// Copyright 2004 P&P Software GmbH - All Rights Reserved
//
// DC_PUSDumpMemoryOffset.cpp
//
// Version      1.0
// Date         4.01.04
// Author       A. Pasetti (P&P Software)

#include "../GeneralInclude/CompilerSwitches.h"
#include "../GeneralInclude/DebugSupport.h"
#include "../GeneralInclude/ClassId.h"
#include "../GeneralInclude/Constants.h"
#include "DC_PUSDumpMemoryOffset.h"
#include "../Telemetry/CC_TelemetryManager.h"
#include "../Telemetry/CC_TelemetryPacketFactory.h"
#include "../Telemetry/DC_PUSMemoryDumpOffset.h"
#include "../Telemetry/DC_PUSMemoryDumpAbsolute.h"
#include "../Data/DataPool.h"

#include <string.h>

DC_PUSDumpMemoryOffset::DC_PUSDumpMemoryOffset(void) {
    setClassId(ID_PUSDUMPMEMORYOFFSET);
    setSubType(PUS_ST_TC_DMP_OFF);
}

TD_ActionOutcome DC_PUSDumpMemoryOffset::doAction(void) {
    assert( isObjectConfigured() );

    CC_TelemetryPacketFactory* pFct = CC_TelemetryPacketFactory::getInstance();
    unsigned int offset;

    // recover the number of blocks
    offset = sizeof(TD_PUSMemId)+sizeof(TD_PUSMemData*);
    TD_PUSNumberMemBlocks numberBlocks;
    memcpy(&numberBlocks,data+offset,sizeof(TD_PUSNumberMemBlocks));

    // compute the length of the fixed part of the telemetry packet
    unsigned int fixedLength;
    fixedLength = sizeof(TD_PUSMemId)+sizeof(TD_PUSMemData*)+sizeof(TD_PUSNumberMemBlocks);
    
    // compute the length of the data part of the telemetry packet
    unsigned int t = fixedLength+sizeof(TD_PUSMemOffset);
    unsigned int dataLength = 0;
    for (TD_PUSNumberMemBlocks i=0; i<numberBlocks; i++) {
        TD_PUSMemLength blockLength;
        memcpy(&blockLength,data+t,sizeof(TD_PUSMemLength));
        dataLength = dataLength+blockLength;
        t = t+sizeof(TD_PUSMemOffset);
    }

    // compute the total length of the telemery packet
    unsigned int packetLength = fixedLength+dataLength+numberBlocks*
                                    (sizeof(TD_PUSMemOffset)+sizeof(TD_PUSMemLength)+sizeof(unsigned short));

    // performa a consistency check: the number of blocks must be consistent with the
    // length of the application data
    if ( numberData!=(fixedLength+numberBlocks*(sizeof(TD_PUSMemOffset)+sizeof(TD_PUSMemLength))) )
        return APP_DATA_INCONSISTENT;

    // recover the telemetry packet from the telemetry factory
    DC_PUSMemoryDumpOffset* pPck = pFct->allocatePUSMemoryDumpOffset(numberBlocks,packetLength);
    if ( pPck==pNULL )
        return PACKET_NOT_FOUND;

    //configure the telemetry packet
    pPck->setNumberBlocks(numberBlocks);
    offset = sizeof(TD_PUSMemId);
    TD_PUSMemData* base;
    memcpy(&base,data+offset,sizeof(TD_PUSMemData*));
    pPck->setBaseAddress(base);
    offset = sizeof(TD_PUSMemId)+sizeof(TD_PUSMemData*)+sizeof(TD_PUSNumberMemBlocks);
    for (TD_PUSNumberMemBlocks i=0; i<numberBlocks; i++) {
        TD_PUSMemOffset blockOffset;
        memcpy(&blockOffset,data+offset,sizeof(TD_PUSMemOffset));
        offset = offset + sizeof(TD_PUSMemOffset);
        TD_PUSMemData* startAddress = base+blockOffset;
        TD_PUSMemLength blockLength;
        memcpy(&blockLength,data+offset,sizeof(TD_PUSMemLength));
        offset = offset + sizeof(TD_PUSMemLength);
        pPck->defineBlock(i,startAddress,blockLength);
    }

    // Load the telemetry packet in the telemetry manager
    if ( !pTmManager->isImmediateQueueFull() ) {
        pPck->setInUse(NOT_IN_USE);    
        return TM_MAN_QUEUE_FULL;
    } else
        pTmManager->sendTelemetryPacket(pPck);
    
    return ACTION_SUCCESS;
}

Copyright 2003 P&P Software GmbH - All Rights Reserved