urg_stamped

Precisely and accurately stamped URG driver for ROS

Backgrounds and Algorithms

2D-LIDAR URG series provides 1ms resolution timestamp and exclusive clock synchronization mode. It was hard to compensate clock drift during measurement using them. Also, the resolution of the timestamp was not enough for a high-speed motion of the sensor.

urg_stamped estimates sub-millisecond timestamp with clock drift compensation. The estimation is structured by following threefold: - Observe sensor internal timestamp by using sensor state command that sometimes responds immediately. - Observe data packet arrival time that is correlated to the true measurement time. - Fuse accurate but low-resolution timestamp and noisy but high-resolution arrival time by the complementary filter.

Usages

Topics and major parameters are designed to be compatible with urg_node.

Published Topics

• scan (sensor_msgs::LaserScan)

Parameters

urg_node compatible parameters

• ip_address (string): device IP address
• ip_port (int): device TCP/IP port
• frame_id (string): frame_id of published scans
• publish_intensity (bool): fill intensity field if true
• error_limit (int): reset the sensor and exit if errors occur more than this count

urg_stamped specific parameters

• sync_interval_min (double): minimum interval to try observing sensor internal timestamp in seconds
• sync_interval_max (double): maximum interval to try observing sensor internal timestamp in seconds
• delay_estim_interval (double): communication delay estimation interval in seconds (dropping 2 or 3 scans during delay estimation)

Known Limitations

• Timestamp estimation is designed for sensors connected by ethernet interface.
  • Tested only for UTM-30LX-EW and UST-20LX at now.
• Some scans are dropped due to the clock synchronization and delay estimation.

Comparison with urg_node

Configurations

Three UTM-30LX-EWs are mounted on a velocity controlled turntable, as shown below, to reconstruct 3-D point cloud from 2-D scans. The accuracy of the timestamp affects offset and precision of the timestamp affects the distribution of the pointcloud.

Results

The image below shows point cloud with 1 rad/s of the turntable which can be assumed as a reference. (decay time of the point cloud: 10 seconds)

urg_node has large error even if calibrate_time and synchronize_time options are enabled (captioned as urg_node (sync)). urg_stamped has better timestamp characteristics comparing with urg_node.

	10 rad/s	20 rad/s
urg_stamped
urg_node
urg_node (sync)

Changelog for package urg_stamped

0.0.8 (2021-03-10)

• Fix token name for releasing (#86)
• Fix prerelease test (#85)
• Remove unnecessary newline from log (#82)
• Migrate to GitHub Actions (#81)
• Contributors: Atsushi Watanabe

0.0.15 (2021-12-15)

• Fix parsing parameter containing semicolon (#123)
• Use Alpine ROS as a cloner base (#122)
• Contributors: Atsushi Watanabe

0.0.14 (2021-08-23)

• Fix continuous time sync failure (#115)
• Tweak indent of stream oprators (#119)
• Gracefully stop connection (#118)
• Improve log outputs for multi-sensor configuration (#116)
• Automatically hide old bot comments (#117)
• Contributors: Atsushi Watanabe

0.0.13 (2021-08-03)

• Remove doubled QT command request (#112)
• Contributors: Atsushi Watanabe

0.0.12 (2021-07-11)

• Fix gpg key source in prerelease test (#111)
• Reboot sensor if time sync error count exceeded limit and never succeeded (#108)
• Rotate bot token (#106)
• Drop Kinetic (#105)
• Contributors: Atsushi Watanabe

0.0.11 (2021-04-23)

• Send QT command twice to avoid being ignored (#103)
• Change TM0 status 10 error log level (#100)
• Fallback timeout during time synchronization (#97)
• Contributors: Atsushi Watanabe

0.0.10 (2021-04-07)

• Add codecov.yml (#96)
• Fix error handling during delay estimation (#92)
• Add option to enable debug log output at launch (#93)
• Send TM command after receiving QT response (#91)
• Refactor directory and namespace (#90)
• Contributors: Atsushi Watanabe

0.0.9 (2021-03-10)

• Release 0.0.8 (#84)
• Fix token name for releasing (#86)
• Fix prerelease test (#85)
• Remove unnecessary newline from log (#82)
• Migrate to GitHub Actions (#81)
• Contributors: Atsushi Watanabe, github-actions[bot]

0.0.7 (2020-08-12)

• Remove travis_retry from prerelease_test.sh (#78)
• Use downloaded gh-pr-comment binary in docker container (#77)
• Download gh-pr-comment binary instead of using pip (#75)
• Reboot lidar when it is in abnormal state (#71)
• Create GitHub Release after bloom release (#72)
• Update CI config (#69)
• Contributors: Atsushi Watanabe, Yuta Koga

0.0.6 (2020-06-23)

• Add check for device timestamp jump to node (#66)
• Add timestamp jump detector to Walltime (#65)
• Contributors: Yuta Koga

0.0.5 (2020-04-07)

• Support Noetic (#61)
• Contributors: Atsushi Watanabe

0.0.4 (2020-01-29)

• Automate bloom release (#58)
• Add error count check (#57)
• Fix response status check (#56)
• Format pointer alignment (#55)
• Contributors: Atsushi Watanabe

0.0.3 (2019-08-15)

• Run prerelease-test on release- branch (#49)
• Refactor logging (#48)
• Drop ROS Indigo and Ubuntu Trusty support (#47)
• Remove old_boost_fix.h (#42)
• Contributors: Atsushi Watanabe

0.0.2 (2018-08-23)

• Fix license in manifest (#39)
• Update README (#36)
• Estimate sub-millisecond timestamp (#35)
  • Estimate sub-millisecond timestamp by complementary filter fusing timestamp and packet arrival time
  • Add packet arrival time outlier removal
  • Add zero-delay moving average
  • Add unit tests for filters
• Add build matrix for ROS indigo/kinetic/melodic (#38)
  • Add build matrix
  • Fix workspace init
  • Fix rosdep argument
  • Fold test details
  • Fix test for latest g++
• Merge pull request #34 from seqsense/update-manifest-format
• Update manifest format
• Receive both MD and ME response by one callback (#33)
• Make some info messages debug level (#30)
• Fix step chage of estimated time origin (#28)
• Update CI settings (#26)
• Apply Apache License 2.0 (#25)
• Add periodic communication delay estimation (#23)
  • Add periodic communication delay estimation
  • Make timeSync and delayEstimation exclusive
  • Retry TM command if not responded
  • Reduce duration for delay estimation
• Fix time origin calculation (#21)
  • Fix delay check
  • Estimate time using received time and estimated delay
  • Fix time origin calculation
• Randomize time sync timing (#20)
• Tweak UTM behavior with intensity (#18)
• Fix II response parsing on UTM (#17)
• Add TCP connection watchdog (#15)
• Handle device timestamp overflow (#12)
  • Handle device timestamp overflow
  • Add test for Walltime
• Add test for Decoder (#14)
• Validate checksum (#11)
• Add publish_intensity parameter (#9)
• Fix clock gain estimation (#7)
  • Rely on sinle clock gain estimation
• Make debug outputs detailed (#6)
• Add CI (#4)
  • Add CI
  • Fix lint errors
• Estimate device clock gain (#3)
• Increase outlier removal thresholds
• Fix message header
• Fix boost placeholder namespace
• Calculate timestamp in system time
• Use urg_node compatible parameter names
• Change path and namespace to scip2
• Add communication delay estimation
• Output LaserScan messages
• Add stream data processors
• Add parameter response processors
• Add base protocol layer
• Add TCP connection layer
• Contributors: Atsushi Watanabe, So Jomura, jojo43