Skip to content

Drivers for the DISCOWER motion capture systems (Qualisys, can be extended to compatible with other mocap systems)

License

Notifications You must be signed in to change notification settings

DISCOWER/motion_capture_system

 
 

Folders and files

NameName
Last commit message
Last commit date

Latest commit

 

History

94 Commits
 
 
 
 
 
 
 
 
 
 

Repository files navigation

ROS2 Driver for DISCOWER's Motion Capture Systems

QUALISYS Logo

Overview

This package contains ROS2 drivers for the QUALISYS motion capture systems. NOTE: This fork ONLY focuses on the Qualisys ROS2 driver.

Keywords: ROS2, motion capture, Qualisys

License

For the QUALISYS driver, we use the Qualisys CPP SDK.

The rest of the source code is released under the Apache 2.0 license, wherever not specified.

Compiling

This is a colcon package. Make sure the package is on ROS_PACKAGE_PATH after cloning the package to your workspace.

cd your_work_space
colcon build

This will compile the drivers for {sys}

Example Usage

Run a qualisys node

ros2 launch mocap_qualisys qualisys.launch.py  server_address:=*QTM server address*

Replace *QTM server address* with the IP address to your QTM server.

Launch files

  • qualisys.launch.py: Launch a qualisys interface node

    • server_address IP address of the server of the motion capture system to be connected. Default: qtm-pc.local.

    • server_base_port The port used for setting up the connection with the motion capture server. Default: 22222.

    • frame_rate Desired frame rate. Will use native frame rate if set to 0. Default: 0.

    • max_accel Max acceleration in m/s. Used to calculate noise parameters. Default: 10.

    • publish_tf Set to true to publish transforms between the tracked bodies and the origin of the motion capture frame. Default: true.

    • fixed_frame_id Frame ID for the motion capture system frame of reference (child frame ids are set to the name of the subject). Default: mocap

    • udp_port Port that the server will stream data to. 0 indicates random UPD port, -1 random TCP port and positive values specifies a UDP port. Default: 0.

    • qtm_protocol_version Minor version of the QTM protocol to use. Default: 18

Nodes

mocap_qualisys_node

Connects to your local QTM server, and publishes poses, odometry and transforms based on 6DOF data.

Published Topics

Parameters

  • server_address (string)

    IP address of the server of the motion capture system to be connected.

  • server_base_port (string, default: 22222)

    The port used for setting up the connection with the motion capture server. Should be left to the default value.

  • frame_rate (int, default: 0)

    The frame rate of the motion capture system. A value of 0 uses whatever framerate the motion capture server is transmiting at. If lower frame rates are requested the server will drop frames to get close to the requested rate. For example, if the server is capturing at 100 FPS and 80 FPS is requested, every other frame will be dropped resulting in 50 FPS.

  • max_accel (double, default: 10.0)

    The max possible acceleration which serves to construct the noise parameters.

  • publish_tf (bool, default: false)

    If set to true, tf msgs for the subjects are published.

  • fixed_frame_id (string, default: mocap)

    The fixed frame ID of the tf msgs for each subject. Note that the child frame id is automatically set to the name of the subject.

  • udp_port (int, default: 0)

    The UDP port that the server will send data to. If set to 0 a random valid port is used. If set to -1 TCP will be used instead of UDP.

  • qtm_protocol_version (int, default: 18)

    The minor version of the QTM protocol that should be used (the only valid major version is 1). Might have to be lowered for very old versions of QTM. Should not be set lower than 8 due to a bug in the protocol version 1.7 and prior causing the rotations to be incorrectly searialized.

  • model_list (vector<string>, default: [])

    A vector of subjects of interest. Leave the vector empty if all subjects are to be tracked.

FAQ

  1. Will the msgs be delayed if the driver is handling several subjects? Possibly. It's not recommended to for example, try to run the node for two dozen bodies on a raspberry pie. The multithreading in earlier versions were removed since it often caused more overhead than actual gain.

Bugs & Feature Requests

Please report bugs and request features using the Issue Tracker.

About

Drivers for the DISCOWER motion capture systems (Qualisys, can be extended to compatible with other mocap systems)

Resources

License

Stars

Watchers

Forks

Releases

No releases published

Packages

No packages published

Languages

  • C++ 98.0%
  • Other 2.0%