You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
203 lines
5.8 KiB
203 lines
5.8 KiB
/*
|
|
* Copyright (c) 2011-2015, Intel Corporation
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without modification,
|
|
* are permitted provided that the following conditions are met:
|
|
*
|
|
* 1. Redistributions of source code must retain the above copyright notice, this
|
|
* list of conditions and the following disclaimer.
|
|
*
|
|
* 2. Redistributions in binary form must reproduce the above copyright notice,
|
|
* this list of conditions and the following disclaimer in the documentation and/or
|
|
* other materials provided with the distribution.
|
|
*
|
|
* 3. Neither the name of the copyright holder nor the names of its contributors
|
|
* may be used to endorse or promote products derived from this software without
|
|
* specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
|
|
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
|
|
* ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
|
* ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
#include "SubsystemObject.h"
|
|
#include "Subsystem.h"
|
|
#include "InstanceConfigurableElement.h"
|
|
#include "ParameterBlackboard.h"
|
|
#include "ParameterAccessContext.h"
|
|
#include "MappingContext.h"
|
|
#include "ParameterType.h"
|
|
#include "convert.hpp"
|
|
#include <assert.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <sstream>
|
|
#include <stdarg.h>
|
|
|
|
using std::string;
|
|
|
|
CSubsystemObject::CSubsystemObject(CInstanceConfigurableElement *pInstanceConfigurableElement,
|
|
core::log::Logger &logger)
|
|
: _logger(logger), _pInstanceConfigurableElement(pInstanceConfigurableElement),
|
|
_dataSize(pInstanceConfigurableElement->getFootPrint())
|
|
{
|
|
// Syncer
|
|
_pInstanceConfigurableElement->setSyncer(this);
|
|
}
|
|
|
|
CSubsystemObject::~CSubsystemObject()
|
|
{
|
|
_pInstanceConfigurableElement->unsetSyncer();
|
|
}
|
|
|
|
string CSubsystemObject::getFormattedMappingValue() const
|
|
{
|
|
// Default formatted mapping value is empty
|
|
return "";
|
|
}
|
|
|
|
// Blackboard data location
|
|
uint8_t *CSubsystemObject::getBlackboardLocation() const
|
|
{
|
|
return _blackboard->getLocation(getOffset());
|
|
}
|
|
|
|
// Size
|
|
size_t CSubsystemObject::getSize() const
|
|
{
|
|
return _dataSize;
|
|
}
|
|
|
|
int CSubsystemObject::toPlainInteger(
|
|
const CInstanceConfigurableElement *instanceConfigurableElement, int sizeOptimizedData)
|
|
{
|
|
if (instanceConfigurableElement) {
|
|
|
|
// Get actual element type
|
|
const CTypeElement *typeElement =
|
|
static_cast<const CParameterType *>(instanceConfigurableElement->getTypeElement());
|
|
|
|
// Do the extension
|
|
return typeElement->toPlainInteger(sizeOptimizedData);
|
|
}
|
|
|
|
return sizeOptimizedData;
|
|
}
|
|
|
|
// Default back synchronization
|
|
void CSubsystemObject::setDefaultValues(CParameterBlackboard ¶meterBlackboard) const
|
|
{
|
|
string strError;
|
|
|
|
// Create access context
|
|
CParameterAccessContext parameterAccessContext(strError, ¶meterBlackboard);
|
|
|
|
// Just implement back synchronization with default values
|
|
_pInstanceConfigurableElement->setDefaultValues(parameterAccessContext);
|
|
}
|
|
|
|
// Synchronization
|
|
bool CSubsystemObject::sync(CParameterBlackboard ¶meterBlackboard, bool bBack, string &strError)
|
|
{
|
|
// Get blackboard location
|
|
_blackboard = ¶meterBlackboard;
|
|
// Access index init
|
|
_accessedIndex = 0;
|
|
|
|
#ifdef SIMULATION
|
|
return true;
|
|
#endif
|
|
|
|
// Retrieve subsystem
|
|
const CSubsystem *pSubsystem = _pInstanceConfigurableElement->getBelongingSubsystem();
|
|
|
|
// Get it's health insdicator
|
|
bool bIsSubsystemAlive = pSubsystem->isAlive();
|
|
|
|
// Check subsystem health
|
|
if (!bIsSubsystemAlive) {
|
|
|
|
strError = "Susbsystem not alive";
|
|
}
|
|
|
|
// Synchronize to/from HW
|
|
if (!bIsSubsystemAlive || !accessHW(bBack, strError)) {
|
|
|
|
// Fall back to parameter default initialization
|
|
if (bBack) {
|
|
|
|
setDefaultValues(parameterBlackboard);
|
|
}
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
// Sync to/from HW
|
|
bool CSubsystemObject::sendToHW(string &strError)
|
|
{
|
|
strError = "Send to HW interface not implemented at subsystem level";
|
|
|
|
return false;
|
|
}
|
|
|
|
bool CSubsystemObject::receiveFromHW(string & /*strError*/)
|
|
{
|
|
// Back synchronization is not supported at subsystem level.
|
|
// Rely on blackboard content
|
|
|
|
return true;
|
|
}
|
|
|
|
// Fall back HW access
|
|
bool CSubsystemObject::accessHW(bool bReceive, string &strError)
|
|
{
|
|
// Default access fall back
|
|
if (bReceive) {
|
|
|
|
return receiveFromHW(strError);
|
|
} else {
|
|
|
|
return sendToHW(strError);
|
|
}
|
|
}
|
|
|
|
// Blackboard access from subsystems
|
|
void CSubsystemObject::blackboardRead(void *pvData, size_t size)
|
|
{
|
|
_blackboard->readBuffer(pvData, size, getOffset() + _accessedIndex);
|
|
|
|
_accessedIndex += size;
|
|
}
|
|
|
|
void CSubsystemObject::blackboardWrite(const void *pvData, size_t size)
|
|
{
|
|
_blackboard->writeBuffer(pvData, size, getOffset() + _accessedIndex);
|
|
|
|
_accessedIndex += size;
|
|
}
|
|
|
|
// Configurable element retrieval
|
|
const CInstanceConfigurableElement *CSubsystemObject::getConfigurableElement() const
|
|
{
|
|
return _pInstanceConfigurableElement;
|
|
}
|
|
// Belonging Subsystem retrieval
|
|
const CSubsystem *CSubsystemObject::getSubsystem() const
|
|
{
|
|
return _pInstanceConfigurableElement->getBelongingSubsystem();
|
|
}
|
|
|
|
size_t CSubsystemObject::getOffset() const
|
|
{
|
|
return _pInstanceConfigurableElement->getOffset();
|
|
}
|