Obbart/universal_robots_ros_driver
1
0
Fork 0
mirror of https://gitlab.com/obbart/universal_robots_ros_driver.git synced 2026-04-09 17:40:47 +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:
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;
@@ -98,6 +98,11 @@ public:
return true;
}
void setProtocolVersion(uint16_t protocol_version)
{
protocol_version_ = protocol_version;
}
private:
std::vector<std::string> recipe_;
RTDEPackage* packageFromType(PackageType type)
@@ -105,7 +110,7 @@ private:
switch (type)
{
case PackageType::RTDE_TEXT_MESSAGE:
return new TextMessage;
return new TextMessage(protocol_version_);
break;
case PackageType::RTDE_GET_URCONTROL_VERSION:
return new GetUrcontrolVersion;
@@ -129,6 +134,7 @@ private:
return new RTDEPackage(type);
}
}
uint16_t protocol_version_;
};
} // 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
{
public:
TextMessage() : RTDEPackage(PackageType::RTDE_TEXT_MESSAGE)
TextMessage(uint16_t protocol_version)
: RTDEPackage(PackageType::RTDE_TEXT_MESSAGE), protocol_version_(protocol_version)
{
}
virtual ~TextMessage() = default;
@@ -50,6 +51,10 @@ public:
uint8_t source_length_;
std::string source_;
uint8_t warning_level_;
uint8_t message_type_;
uint16_t protocol_version_;
};
} // 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
size = GetUrcontrolVersionRequest::generateSerializedRequest(buffer);
stream_.write(buffer, size, written);

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

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