Page MenuHomePhorge
Files F27036557

SensorHandlerOfAgent.cpp
No OneTemporary
Actions

Authored By
Unknown
Size
6 KB
Referenced Files
None
Subscribers
None

SensorHandlerOfAgent.cpp
View Options

#include "SensorHandlerOfAgent.h"
#include <stdio.h>
#include "printError.h"
#include <algorithm>
#define MAXNUMOF_MOUNTEDSENSORS 100
//#define PRINT
using namespace std;
SensorHandlerOfAgent :: SensorHandlerOfAgent() {
init_sensorHandler();
}
void SensorHandlerOfAgent :: init_sensorHandler() {
maxNumOf_mountedSensors = MAXNUMOF_MOUNTEDSENSORS;
}
//TODO: if(vMountedSensors.size() < maxNumOf_mountedSensors) als aller erste Abfrage machen ... noch bevor "SensorSlotOfAgent* sensorSlotOfAgent = new SensorSlotOfAgent();"
//TODO: delete object if it cannot added to vector
bool SensorHandlerOfAgent :: mount_sensorIntoSensorSlot(Channel* inputPort) {
SensorSlotOfAgent* sensorSlotOfAgent = new SensorSlotOfAgent();
if(sensorSlotOfAgent != NULL) {
if(sensorSlotOfAgent->set_comPort(inputPort)) {
try {
if(vMountedSensors.size() < maxNumOf_mountedSensors) {
vMountedSensors.push_back(sensorSlotOfAgent);
}
else {
printError("Max number of mounted sensors is already reached!");
return false;
}
}
catch(bad_alloc& error) {
printError("bad_alloc caught: ", error.what());
return false;
}
return true;
}
else {
printError("Input port is no set!");
vMountedSensors.pop_back(); //TODO: check if it is right?!?!
return false;
}
}
else {
printError("Couldn't create SensorSlot!");
return false;
}
}
//TODO: what to do when 2 sensorSlots have the same inputPort??!!
SensorSlotOfAgent* SensorHandlerOfAgent :: get_sensorSlotAddress(Channel* inputPort) {
for(auto &sensorSlot : vMountedSensors) {
if(sensorSlot->get_comPort() == inputPort) {
return sensorSlot;
}
}
return NULL;
}
//TODO: what to do when 2 slaveAgentSlots have the same inputPort??!!
//TODO: case if slot with comPort is not in this vector
unsigned int SensorHandlerOfAgent :: get_sensorSlotNumber(Channel* inputPort) {
unsigned int slotNumber = 0;
for(auto &sensorSlot : vMountedSensors) {
if(sensorSlot->get_comPort() == inputPort) {
return slotNumber;
}
slotNumber++;
}
return std::numeric_limits<int>::quiet_NaN();
}
//TODO: what to do when 2 sensorSlots have the same historyModule??!!
SensorSlotOfAgent* SensorHandlerOfAgent :: get_sensorSlotAddress(HistoryModule* historyModule) {
for(auto &sensorSlot : vMountedSensors) {
if(sensorSlot->get_historyModule() == historyModule) {
return sensorSlot;
}
}
return NULL;
}
//TODO: what to do when 2 sensorSlots have the same confidenceModule??!!
SensorSlotOfAgent* SensorHandlerOfAgent :: get_sensorSlotAddress(ConfidenceModule* confidenceModule) {
for(auto &sensorSlot : vMountedSensors) {
if(sensorSlot->get_confidenceModule() == confidenceModule) {
return sensorSlot;
}
}
return NULL;
}
bool SensorHandlerOfAgent :: demount_sensor(Channel* inputPort) {
vMountedSensors.erase(vMountedSensors.begin() + get_sensorSlotNumber(inputPort));
return false;
}
//TODO: do it also for integer variables
bool SensorHandlerOfAgent :: read_sensorValue(SensorSlotOfAgent* sensorSlotOfAgent) {
if(sensorSlotOfAgent != NULL) {
Channel* channel = sensorSlotOfAgent->get_comPort();
if(channel != NULL) {
float inputValue;
if(channel->get_MsgUp(&inputValue)) {
sensorSlotOfAgent->set_sensorValue(inputValue);
#ifdef PRINT
printf("Agent read from %s: %f\n", channel->get_name().c_str(), inputValue);
#endif // PRINT
return true;
}
}
}
return false;
}
bool SensorHandlerOfAgent :: read_allSensorValues() {
bool flag_readSensor = false;
for(auto &sensorSlot : vMountedSensors) {
if(read_sensorValue(sensorSlot)) {
flag_readSensor = true;
}
}
return flag_readSensor;
}
bool SensorHandlerOfAgent :: attach_historyModule(Channel* inputPort, HistoryModule* historyModule) {
SensorSlotOfAgent* sensorSlotOfAgent = get_sensorSlotAddress(inputPort);
if(sensorSlotOfAgent != NULL) {
return sensorSlotOfAgent->set_historyModule(historyModule);
}
return false;
}
bool SensorHandlerOfAgent :: detach_historyModule(SensorSlotOfAgent* sensorSlotOfAgent) {
if(sensorSlotOfAgent != NULL) {
return sensorSlotOfAgent->del_historyModule();
}
return false;
}
bool SensorHandlerOfAgent :: detach_historyModule(Channel* inputPort) {
SensorSlotOfAgent* sensorSlotOfAgent = get_sensorSlotAddress(inputPort);
return detach_historyModule(sensorSlotOfAgent);
}
bool SensorHandlerOfAgent :: detach_historyModule(HistoryModule* historyModule) {
SensorSlotOfAgent* sensorSlotOfAgent = get_sensorSlotAddress(historyModule);
return detach_historyModule(sensorSlotOfAgent);
}
HistoryModule* SensorHandlerOfAgent :: get_historyModuleOfSensorSlot(Channel* inputPort) {
SensorSlotOfAgent* sensorSlotOfAgent = get_sensorSlotAddress(inputPort);
return sensorSlotOfAgent->get_historyModule();
}
bool SensorHandlerOfAgent :: attach_confidenceModule(Channel* inputPort, ConfidenceModule* confidenceModule) {
SensorSlotOfAgent* sensorSlotOfAgent = get_sensorSlotAddress(inputPort);
if(sensorSlotOfAgent != NULL) {
return sensorSlotOfAgent->set_confidenceModule(confidenceModule);
}
return false;
}
bool SensorHandlerOfAgent :: detach_confidenceModule(SensorSlotOfAgent* sensorSlotOfAgent) {
if(sensorSlotOfAgent != NULL) {
return sensorSlotOfAgent->del_confidenceModule();
}
return false;
}
bool SensorHandlerOfAgent :: detach_confidenceModule(Channel* inputPort) {
SensorSlotOfAgent* sensorSlotOfAgent = get_sensorSlotAddress(inputPort);
return detach_confidenceModule(sensorSlotOfAgent);
}
bool SensorHandlerOfAgent :: detach_confidenceModule(ConfidenceModule* confidenceModule) {
SensorSlotOfAgent* sensorSlotOfAgent = get_sensorSlotAddress(confidenceModule);
return detach_confidenceModule(sensorSlotOfAgent);
}
ConfidenceModule* SensorHandlerOfAgent :: get_confidenceModuleOfSensorSlot(Channel* inputPort) {
SensorSlotOfAgent* sensorSlotOfAgent = get_sensorSlotAddress(inputPort);
return sensorSlotOfAgent->get_confidenceModule();
}
vector<SensorSlotOfAgent*>* SensorHandlerOfAgent :: get_vMountedSensors() {
return &vMountedSensors;
}
void SensorHandlerOfAgent :: delete_all_Mounted_Sensors()
{
SensorSlotOfAgent* cur_Sensor_Slot_Agent;
unsigned int index_cur_Sen_Slo_Ag;
unsigned int size_vec_Mount_Sensors = vMountedSensors.size();
for(index_cur_Sen_Slo_Ag = 0; index_cur_Sen_Slo_Ag < size_vec_Mount_Sensors; index_cur_Sen_Slo_Ag++){
cur_Sensor_Slot_Agent = vMountedSensors[index_cur_Sen_Slo_Ag];
delete cur_Sensor_Slot_Agent;
}
vMountedSensors.clear();
}
SensorHandlerOfAgent :: ~SensorHandlerOfAgent()
{
delete_all_Mounted_Sensors();
}

File Metadata

Mime Type
text/x-c++
Expires
Tue, Oct 27, 8:02 PM (1 d, 20 h)
Storage Engine
blob
Storage Format
Raw Data
Storage Handle
411431
Default Alt Text
SensorHandlerOfAgent.cpp (6 KB)

Event Timeline