Obbart/universal_robots_ros_driver
1
0
Fork 0
mirror of https://gitlab.com/obbart/universal_robots_ros_driver.git synced 2026-04-10 01:50:46 +02:00
Code Releases Activity

implemented handling of different protocol versions for rtde text message parsing

Browse Source
This commit is contained in:
Tristan Schnell
2019-07-17 17:14:13 +02:00
parent 6ea9bc05ec
commit 0519866bb4
4 changed files with 29 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
ur_rtde_driver/include/ur_rtde_driver/rtde/rtde_parser.h
View File

@@ -42,7 +42,7 @@ class RTDEParser : public comm::Parser<PackageHeader>
{ {
public: public:
RTDEParser() = delete; RTDEParser() = delete;
RTDEParser(const std::vector<std::string>& recipe) : recipe_(recipe) RTDEParser(const std::vector<std::string>& recipe) : recipe_(recipe), protocol_version_(1)
{ {
} }
virtual ~RTDEParser() = default; virtual ~RTDEParser() = default;
@@ -98,6 +98,11 @@ public:
return true; return true;
} }
void setProtocolVersion(uint16_t protocol_version)
{
protocol_version_ = protocol_version;
}
private: private:
std::vector<std::string> recipe_; std::vector<std::string> recipe_;
RTDEPackage* packageFromType(PackageType type) RTDEPackage* packageFromType(PackageType type)
@@ -105,7 +110,7 @@ private:
switch (type) switch (type)
{ {
case PackageType::RTDE_TEXT_MESSAGE: case PackageType::RTDE_TEXT_MESSAGE:
return new TextMessage; return new TextMessage(protocol_version_);
break; break;
case PackageType::RTDE_GET_URCONTROL_VERSION: case PackageType::RTDE_GET_URCONTROL_VERSION:
return new GetUrcontrolVersion; return new GetUrcontrolVersion;
@@ -129,6 +134,7 @@ private:
return new RTDEPackage(type); return new RTDEPackage(type);
} }
} }
uint16_t protocol_version_;
}; };
} // namespace rtde_interface } // namespace rtde_interface

7
ur_rtde_driver/include/ur_rtde_driver/rtde/text_message.h
View File

@@ -37,7 +37,8 @@ namespace rtde_interface
class TextMessage : public RTDEPackage class TextMessage : public RTDEPackage
{ {
public: public:
TextMessage() : RTDEPackage(PackageType::RTDE_TEXT_MESSAGE) TextMessage(uint16_t protocol_version)
: RTDEPackage(PackageType::RTDE_TEXT_MESSAGE), protocol_version_(protocol_version)
{ {
} }
virtual ~TextMessage() = default; virtual ~TextMessage() = default;
@@ -50,6 +51,10 @@ public:
uint8_t source_length_; uint8_t source_length_;
std::string source_; std::string source_;
uint8_t warning_level_; uint8_t warning_level_;
uint8_t message_type_;
uint16_t protocol_version_;
}; };
} // namespace rtde_interface } // namespace rtde_interface

2
ur_rtde_driver/src/rtde/rtde_client.cpp
View File

@@ -74,6 +74,8 @@ bool RTDEClient::init()
} }
} }
parser_.setProtocolVersion(protocol_version);
// determine maximum frequency from ur-control version // determine maximum frequency from ur-control version
size = GetUrcontrolVersionRequest::generateSerializedRequest(buffer); size = GetUrcontrolVersionRequest::generateSerializedRequest(buffer);
stream_.write(buffer, size, written); stream_.write(buffer, size, written);

8
ur_rtde_driver/src/rtde/text_message.cpp
View File

@@ -33,11 +33,19 @@ namespace rtde_interface
{ {
bool TextMessage::parseWith(comm::BinParser& bp) bool TextMessage::parseWith(comm::BinParser& bp)
{ {
if (protocol_version_ == 2)
{
bp.parse(message_length_); bp.parse(message_length_);
bp.parse(message_, message_length_); bp.parse(message_, message_length_);
bp.parse(source_length_); bp.parse(source_length_);
bp.parse(source_, source_length_); bp.parse(source_, source_length_);
bp.parse(warning_level_); bp.parse(warning_level_);
}
else if (protocol_version_ == 1)
{
bp.parse(message_type_);
bp.parseRemainder(message_);
}
return true; return true;
} }