jaus++/2.0/src/jaus/extras/mcu/querymicrocontrollerstate.cpp
Go to the documentation of this file.
00001 00002 00003 00004 00005 00006 00007 00008 00009 00010 00011 00012 00013 00014 00015 00016 00017 00018 00019 00020 00021 00022 00023 00024 00025 00026 00027 00028 00029 00030 00031 00032 00033 00034 00035 00036 00037 00038 00039 00040 #include "jaus/extras/mcu/querymicrocontrollerstate.h" 00041 00042 using namespace JAUS; 00043 00044 00056 int QueryMicrocontrollerState::WriteMessageBody(Packet& packet) const 00057 { 00058 int total = 0; 00059 int expected = UINT_SIZE*2; 00060 00061 std::set<std::string>::const_iterator name; 00062 00063 total += packet.Write((UInt)mDigitalDevices.size()); 00064 00065 for(name = mDigitalDevices.begin(); 00066 name != mDigitalDevices.end(); 00067 name++) 00068 { 00069 expected += UINT_SIZE + (UInt)name->size(); 00070 total += packet.Write((UInt)name->size()); 00071 total += packet.Write((const unsigned char *)name->c_str(), (UInt)name->size()); 00072 } 00073 00074 total += packet.Write((UInt)mAnalogDevices.size()); 00075 00076 for(name = mAnalogDevices.begin(); 00077 name != mAnalogDevices.end(); 00078 name++) 00079 { 00080 expected += UINT_SIZE + (UInt)name->size(); 00081 total += packet.Write((UInt)name->size()); 00082 total += packet.Write((const unsigned char *)name->c_str(), (UInt)name->size()); 00083 } 00084 00085 return total == expected ? total : -1; 00086 } 00087 00088 00100 int QueryMicrocontrollerState::ReadMessageBody(const Packet& packet) 00101 { 00102 int total = 0; 00103 int expected = UINT_SIZE*2; 00104 UInt size = 0; 00105 00106 total += packet.Read(size); 00107 00108 for(UInt i = 0; i < size; i++) 00109 { 00110 UInt len = 0; 00111 expected += UINT_SIZE; 00112 total += packet.Read(len); 00113 expected += len; 00114 std::string str; 00115 total += packet.Read(str, len); 00116 mDigitalDevices.insert(str); 00117 } 00118 00119 size = 0; 00120 total += packet.Read(size); 00121 00122 for(UInt i = 0; i < size; i++) 00123 { 00124 UInt len = 0; 00125 expected += UINT_SIZE; 00126 total += packet.Read(len); 00127 expected += len; 00128 std::string str; 00129 total += packet.Read(str, len); 00130 mAnalogDevices.insert(str); 00131 } 00132 00133 return total == expected ? total : -1; 00134 } 00135 00136 00143 bool QueryMicrocontrollerState::IsLargeDataSet(const unsigned int maxPayloadSize) const 00144 { 00145 unsigned int expected = UINT_SIZE*2; 00146 00147 std::set<std::string>::const_iterator name; 00148 00149 for(name = mDigitalDevices.begin(); 00150 name != mDigitalDevices.end(); 00151 name++) 00152 { 00153 expected += UINT_SIZE + (UInt)name->size(); 00154 } 00155 00156 for(name = mAnalogDevices.begin(); 00157 name != mAnalogDevices.end(); 00158 name++) 00159 { 00160 expected += UINT_SIZE + (UInt)name->size(); 00161 } 00162 00163 return expected > maxPayloadSize ? true : false; 00164 } 00165 00166 /* End of File */
