80 lines
2.1 KiB
C++
80 lines
2.1 KiB
C++
/*
|
|
* LocalMemory.cpp
|
|
*
|
|
* Created on: 05.11.2013
|
|
* Author: Bastian
|
|
*/
|
|
|
|
#include <bsp_flp/hw_prom/HwProm.h>
|
|
#include <framework/memory/LocalMemory.h>
|
|
#include <framework/serialize/SerializeAdapter.h>
|
|
|
|
LocalMemory::LocalMemory(object_id_t setObjectId) :
|
|
SystemObject(setObjectId), commandQueue(), memoryHelper(this,
|
|
&commandQueue) {
|
|
}
|
|
|
|
ReturnValue_t LocalMemory::performOperation() {
|
|
ReturnValue_t handleResult;
|
|
CommandMessage message;
|
|
for (ReturnValue_t result = commandQueue.receiveMessage(&message);
|
|
result == HasReturnvaluesIF::RETURN_OK;
|
|
result = commandQueue.receiveMessage(&message)) {
|
|
handleResult = memoryHelper.handleMemoryCommand(&message);
|
|
if (handleResult != HasReturnvaluesIF::RETURN_OK) {
|
|
message.setToUnknownCommand(message.getCommand());
|
|
commandQueue.reply(&message);
|
|
}
|
|
}
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
|
|
ReturnValue_t LocalMemory::handleMemoryLoad(uint32_t address,
|
|
const uint8_t* data, uint32_t size, uint8_t** dataPointer) {
|
|
ReturnValue_t result = checkWriteAccess(address, size);
|
|
if (result == HasReturnvaluesIF::RETURN_OK) {
|
|
uint32_t value = 0;
|
|
for (uint32_t temp_address = address; temp_address < (address + size);
|
|
temp_address += 4, data += 4) {
|
|
value = (data[0] << 24) + (data[1] << 16) + (data[2] << 8) + data[3];
|
|
*((uint32_t*) temp_address) = value;
|
|
}
|
|
}
|
|
return result;
|
|
}
|
|
|
|
ReturnValue_t LocalMemory::handleMemoryDump(uint32_t address, uint32_t size,
|
|
uint8_t** dataPointer, uint8_t* dumpTarget) {
|
|
*dataPointer = (uint8_t*) address;
|
|
return POINTS_TO_MEMORY;
|
|
}
|
|
|
|
ReturnValue_t LocalMemory::initialize() {
|
|
return memoryHelper.initialize();
|
|
}
|
|
|
|
MessageQueueId_t LocalMemory::getCommandQueue() const {
|
|
return commandQueue.getId();
|
|
}
|
|
|
|
ReturnValue_t LocalMemory::checkWriteAccess(uint32_t address, uint32_t size) {
|
|
|
|
if ((address % 4) != 0) {
|
|
return UNALIGNED_ACCESS;
|
|
}
|
|
|
|
if ((size % 4) != 0) {
|
|
return INVALID_SIZE;
|
|
}
|
|
|
|
if (address < 0x40000000) {
|
|
HwProm prom(false);
|
|
if (prom.getPromWriteEnabled() != HwProm::WRITE_ENABLED) {
|
|
return WRITE_PROTECTED;
|
|
}
|
|
}
|
|
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
|