103 lines
2.7 KiB
C++
103 lines
2.7 KiB
C++
|
/*
|
||
|
|
* MessageProxy.cpp
|
||
|
|
*
|
||
|
|
* Created on: 18.03.2015
|
||
|
|
* Author: baetz
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <framework/ipc/MessageProxy.h>
|
||
|
|
|
||
|
|
MessageProxy::~MessageProxy() {
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
MessageQueueId_t MessageProxy::getReceiver() const {
|
||
|
|
return receiver;
|
||
|
|
}
|
||
|
|
|
||
|
|
MessageQueueId_t MessageProxy::getCommandQueue() const {
|
||
|
|
return commandQueue.getId();
|
||
|
|
}
|
||
|
|
|
||
|
|
void MessageProxy::setReceiver(MessageQueueId_t configuredReceiver) {
|
||
|
|
this->receiver = configuredReceiver;
|
||
|
|
}
|
||
|
|
|
||
|
|
MessageProxy::MessageProxy(size_t queueDepth, MessageQueueId_t setReceiver) :
|
||
|
|
receiver(setReceiver), currentRequest(0), commandQueue(queueDepth) {
|
||
|
|
}
|
||
|
|
|
||
|
|
void MessageProxy::checkCommandQueue() {
|
||
|
|
CommandMessage message;
|
||
|
|
MessageQueueId_t senderId;
|
||
|
|
ReturnValue_t result = commandQueue.receiveMessage(&message, &senderId);
|
||
|
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
if (senderId != receiver) {
|
||
|
|
//It's a command.
|
||
|
|
if (currentRequest == 0) {
|
||
|
|
result = commandQueue.sendMessage(receiver, &message);
|
||
|
|
if (result == HasReturnvaluesIF::RETURN_OK) {
|
||
|
|
currentRequest = senderId;
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
result = commandFifo.insert(message);
|
||
|
|
}
|
||
|
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||
|
|
message.clear();
|
||
|
|
CommandMessage reply;
|
||
|
|
reply.setReplyRejected(result, message.getCommand());
|
||
|
|
commandQueue.reply(&reply);
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
//It's a reply.
|
||
|
|
if (currentRequest != 0) {
|
||
|
|
//Failed forwarding is ignored.
|
||
|
|
commandQueue.sendMessage(currentRequest, &message);
|
||
|
|
//This request is finished.
|
||
|
|
currentRequest = 0;
|
||
|
|
//Check if there's another request in FIFO:
|
||
|
|
result = commandFifo.retrieve(&message);
|
||
|
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||
|
|
//Nothing in FIFO.
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
currentRequest = message.getSender();
|
||
|
|
result = commandQueue.sendMessage(receiver, &message);
|
||
|
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||
|
|
message.clear();
|
||
|
|
CommandMessage reply;
|
||
|
|
reply.setReplyRejected(result, message.getCommand());
|
||
|
|
commandQueue.reply(&reply);
|
||
|
|
currentRequest = 0;
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
//We don't expect a reply. Ignore.
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void MessageProxy::flush() {
|
||
|
|
CommandMessage command;
|
||
|
|
CommandMessage reply;
|
||
|
|
if (currentRequest != 0) {
|
||
|
|
commandQueue.sendMessage(currentRequest, &reply);
|
||
|
|
currentRequest = 0;
|
||
|
|
}
|
||
|
|
for (ReturnValue_t result = commandQueue.receiveMessage(&command);
|
||
|
|
result == HasReturnvaluesIF::RETURN_OK;
|
||
|
|
result = commandQueue.receiveMessage(&command)) {
|
||
|
|
reply.setReplyRejected(FLUSHED, command.getCommand());
|
||
|
|
commandQueue.reply(&reply);
|
||
|
|
command.clear();
|
||
|
|
}
|
||
|
|
for (ReturnValue_t result = commandFifo.retrieve(&command);
|
||
|
|
result == HasReturnvaluesIF::RETURN_OK;
|
||
|
|
result = commandFifo.retrieve(&command)) {
|
||
|
|
reply.setReplyRejected(FLUSHED, command.getCommand());
|
||
|
|
commandQueue.sendMessage(command.getSender(), &reply);
|
||
|
|
command.clear();
|
||
|
|
}
|
||
|
|
}
|