129static const std::string RoleTypeStr[]
130 = {
"UNKNOWN",
"LAN_TELEOP",
"WAN_TELEOP_LEADER",
"WAN_TELEOP_FOLLOWER"};
144 std::array<double, kPoseSize> pose {};
153 std::array<double, kCartDoF> velocity {};
162 std::array<double, kCartDoF> acceleration {};
167 mutable std::mutex mutex;
176 void read(std::array<double, kPoseSize>& out_pose, std::array<double, kCartDoF>& out_velocity,
177 std::array<double, kCartDoF>& out_acceleration)
const
179 std::lock_guard<std::mutex> lock(mutex);
181 out_velocity = velocity;
182 out_acceleration = acceleration;
191 void write(
const std::array<double, kPoseSize>& in_pose,
192 const std::array<double, kCartDoF>& in_velocity,
193 const std::array<double, kCartDoF>& in_acceleration)
195 std::lock_guard<std::mutex> lock(mutex);
197 velocity = in_velocity;
198 acceleration = in_acceleration;
206 std::lock_guard<std::mutex> lock(mutex);
211 acceleration.fill(0);
226static const std::string CoordTypeStr[] = {
"UNKNOWN",
"TCP",
"WORLD"};
233static inline CoordType GetCoordType(
const std::string& str)
235 for (
size_t i = 0; i < COORD_WORLD - COORD_UNKNOWN + 1; i++) {
236 if (str == CoordTypeStr[i]) {
237 return static_cast<CoordType
>(i);
300static const std::string TeleopIssueCodeStr[] = {
"NONE",
"JOINT_LIMIT",
"SINGULARITY",
301 "HIGH_JOINT_VELOCITY",
"HIGH_LATENCY",
"NETWORK_DISCONNECTED",
"CLOCK_MISMATCH",
"ROBOT_FAULT",
302 "ROBOT_NOT_OPERATIONAL",
"CONTROL_MODE_MISMATCH"};
315static const std::string TeleopIssueLevelStr[] = {
"INFO",
"WARNING",
"ERROR"};
329static const std::string TeleopIssueSideStr[] = {
"NONE",
"LEADER",
"FOLLOWER",
"NETWORK"};
Role
Roles of participants in transparent cartesian teleop.
@ LAN_TELEOP
Teleoperation in LAN.
@ WAN_TELEOP_LEADER
The leader robot operated by a human during teleoperation over WAN.
TeleopIssueCode
Issue code and possible reasons for a teleoperation restriction or interruption.
@ JOINT_LIMIT
A joint is near its position limit.
@ CONTROL_MODE_MISMATCH
Robot left real-time Cartesian motion-force mode.
@ ROBOT_NOT_OPERATIONAL
Robot is not operational (E-Stop, disabled, or link lost).
@ ROBOT_FAULT
Robot is in fault state.
@ NETWORK_DISCONNECTED
Connection to the peer is not established.
@ SINGULARITY
Arm is near a kinematic singularity.
@ HIGH_JOINT_VELOCITY
Joint velocity is close to the safety limit.
@ CLOCK_MISMATCH
Clocks disagree (negative latency); teleop is force-disengaged.
TeleopIssueLevel
How urgently a teleop issue should be presented to the operator.
@ WARNING
Motion is restricted.
@ INFO
Advisory. Motion is still possible.
@ ERROR
Teleop was disengaged, stopped, or the robot needs recovery.
CoordType
Reference coordinate that the axis to be locked used by transparent cartesian teleop.
@ COORD_UNKNOWN
Unknown coordinate.
@ COORD_WORLD
WORLD coordinate of local robot.
@ COORD_TCP
TCP coordinate of local robot.
constexpr size_t kIOPorts
constexpr size_t kMaxRobotPairsNum
constexpr double kMaxWrenchFeedbackScale
TeleopIssueSide
Which participant the issue belongs to.
@ NETWORK
Link between the two sides, not a specific robot.
@ FOLLOWER
Follower / remote-environment robot.
@ LEADER
Leader / operator-side robot.
TeleopIssueLevel GetTeleopIssueLevel(TeleopIssueCode code)
Default level for a teleop issue code.
ZeroFTSensor
Sensor calibration options.
constexpr size_t kPoseSize
constexpr size_t kCartDoF
Data for locking axis, including reference frame and axis to be locked for transparent cartesian tele...
std::array< bool, 3 > lock_ori_axis
Orientation axis lock, the corresponding axis order is . True for locking, false for floating.
std::array< bool, 3 > lock_trans_axis
Translation axis lock, the corresponding axis order is . True for locking, false for floating.
CoordType coord
Reference coordinate that the axis to be locked.
Motion control command struct for general device-robot teleop.
void zero()
Thread-safe zero function: set all data to 0.
void read(std::array< double, kPoseSize > &out_pose, std::array< double, kCartDoF > &out_velocity, std::array< double, kCartDoF > &out_acceleration) const
Thread-safe read function: copy data to output parameters.
void write(const std::array< double, kPoseSize > &in_pose, const std::array< double, kCartDoF > &in_velocity, const std::array< double, kCartDoF > &in_acceleration)
Thread-safe write function: copy the input parameters to member variables.
Network configuration for TDK Professional Edition (credential file from TDK Server).
std::string client_config_file
std::vector< std::string > lan_interface_whitelist
TCP Server and Client Configuration TDK Standard Edition. In a teleoperation-over-WAN setup,...
std::string public_ipv4_address
std::vector< std::string > lan_interface_whitelist
unsigned int listening_port
std::vector< std::string > wan_interface_whitelist
One restriction or interruption that the operator should understand.
Snapshot of teleoperation health for one robot pair.
std::vector< TeleopIssue > issues
double latency_threshold_ms