90 lines
2.4 KiB
C++
90 lines
2.4 KiB
C++
|
#include "../devicehandlers/DeviceCommunicationIF.h"
|
||
|
|
#include "rmapStructs.h"
|
||
|
|
#include "RMAP.h"
|
||
|
|
#include "RMAPChannelIF.h"
|
||
|
|
#include <stddef.h>
|
||
|
|
|
||
|
|
ReturnValue_t RMAP::reset(RMAPCookie* cookie) {
|
||
|
|
return cookie->getChannel()->reset();
|
||
|
|
}
|
||
|
|
|
||
|
|
RMAP::RMAP(){
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
ReturnValue_t RMAP::sendWriteCommand(RMAPCookie *cookie, uint8_t* buffer,
|
||
|
|
uint32_t length) {
|
||
|
|
uint8_t instruction;
|
||
|
|
|
||
|
|
if ((buffer == NULL) && (length != 0)) {
|
||
|
|
return DeviceCommunicationIF::NULLPOINTER;
|
||
|
|
}
|
||
|
|
if (cookie->getChannel() == NULL) {
|
||
|
|
return COMMAND_NO_CHANNEL;
|
||
|
|
}
|
||
|
|
instruction = RMAPIds::RMAP_COMMAND_WRITE | cookie->getCommandMask();
|
||
|
|
return cookie->getChannel()->sendCommand(cookie, instruction, buffer,
|
||
|
|
length);
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
ReturnValue_t RMAP::getWriteReply(RMAPCookie *cookie) {
|
||
|
|
if (cookie->getChannel() == NULL) {
|
||
|
|
return COMMAND_NO_CHANNEL;
|
||
|
|
}
|
||
|
|
if (cookie->getHeader()->instruction & (1 << RMAPIds::RMAP_COMMAND_BIT_WRITE)) {
|
||
|
|
return cookie->getChannel()->getReply(cookie, NULL, NULL);
|
||
|
|
} else {
|
||
|
|
return REPLY_MISSMATCH;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
ReturnValue_t RMAP::writeBlocking(RMAPCookie *cookie, uint8_t* buffer,
|
||
|
|
uint32_t length, uint32_t timeout_us) {
|
||
|
|
if (cookie->getChannel() == NULL) {
|
||
|
|
return COMMAND_NO_CHANNEL;
|
||
|
|
}
|
||
|
|
return cookie->getChannel()->sendCommandBlocking(cookie, buffer, length,
|
||
|
|
NULL, NULL, timeout_us);
|
||
|
|
|
||
|
|
}
|
||
|
|
ReturnValue_t RMAP::sendReadCommand(RMAPCookie *cookie, uint32_t expLength) {
|
||
|
|
uint8_t command;
|
||
|
|
if (cookie->getChannel() == NULL) {
|
||
|
|
return COMMAND_NO_CHANNEL;
|
||
|
|
}
|
||
|
|
command = RMAPIds::RMAP_COMMAND_READ
|
||
|
|
| (cookie->getCommandMask() & ~(1 << RMAPIds::RMAP_COMMAND_BIT_VERIFY));
|
||
|
|
|
||
|
|
return cookie->getChannel()->sendCommand(cookie, command, NULL, expLength);
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
ReturnValue_t RMAP::getReadReply(RMAPCookie *cookie, uint8_t **buffer,
|
||
|
|
uint32_t *size) {
|
||
|
|
if (cookie->getChannel() == NULL) {
|
||
|
|
return COMMAND_NO_CHANNEL;
|
||
|
|
}
|
||
|
|
if (buffer == NULL || size == NULL) {
|
||
|
|
return DeviceCommunicationIF::NULLPOINTER;
|
||
|
|
}
|
||
|
|
if (cookie->getHeader()->instruction & (1 << RMAPIds::RMAP_COMMAND_BIT_WRITE)) {
|
||
|
|
return REPLY_MISSMATCH;
|
||
|
|
} else {
|
||
|
|
return cookie->getChannel()->getReply(cookie, buffer, size);
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
ReturnValue_t RMAP::readBlocking(RMAPCookie *cookie, uint32_t expLength,
|
||
|
|
uint8_t** buffer, uint32_t *size, uint32_t timeout_us) {
|
||
|
|
if (cookie->getChannel() == NULL) {
|
||
|
|
return COMMAND_NO_CHANNEL;
|
||
|
|
}
|
||
|
|
if (buffer == NULL || size == NULL) {
|
||
|
|
return DeviceCommunicationIF::NULLPOINTER;
|
||
|
|
}
|
||
|
|
return cookie->getChannel()->sendCommandBlocking(cookie, NULL, expLength,
|
||
|
|
buffer, size, timeout_us);
|
||
|
|
}
|