Skip to content

damiendr/RobotOSData.jl

Folders and files

NameName
Last commit message
Last commit date

Latest commit

 

History

27 Commits
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 

Repository files navigation

RobotOSData

Work in progress: you can use this package by installing it directly from this git repository, but it is not registered yet

Build Status Coverage Status

A library to read data from ROS bags and messages in Julia.

This package has no dependencies on the ROS codebase: you can use it without a working ROS install.

Only ROS bags v2.0 are supported at the moment. If you'd like support for earlier versions, do open an issue or submit a pull request.

Reading from uncompressed bags is pretty fast (up to 500 MB/s on my laptop). Bags with BZip2 compression are supported, but reading these is about two orders of magnitude slower. Profiling shows that most of that time is spent in libbzip2 itself, so there is probably not much that can be done to make it faster.

Basic Usage

Load a bag file through FileIO:

using RobotOSData
using FileIO
bag = load("indoor_flying1_data.bag")

This parses the index structure and shows a summary of the contents:

ROS Bag v2.0 at indoor_flying1_data.bag
1437 uncompressed chunks with 1.2 GiB of message data
154942 messages in 9 topics:
 └─/davis/right/imu:                sensor_msgs/Imu => RobotOSData.CommonMsgs.sensor_msgs.Imu
 └─/davis/left/imu:                 sensor_msgs/Imu => RobotOSData.CommonMsgs.sensor_msgs.Imu
 └─/davis/right/events:         dvs_msgs/EventArray => Array{UInt8,1}
 └─/davis/left/events:          dvs_msgs/EventArray => Array{UInt8,1}
 └─/davis/left/camera_info:  sensor_msgs/CameraInfo => RobotOSData.CommonMsgs.sensor_msgs.CameraInfo
 └─/davis/left/image_raw:         sensor_msgs/Image => RobotOSData.CommonMsgs.sensor_msgs.Image
 └─/velodyne_point_cloud:   sensor_msgs/PointCloud2 => RobotOSData.CommonMsgs.sensor_msgs.PointCloud2
 └─/davis/right/camera_info: sensor_msgs/CameraInfo => RobotOSData.CommonMsgs.sensor_msgs.CameraInfo
 └─/davis/right/image_raw:        sensor_msgs/Image => RobotOSData.CommonMsgs.sensor_msgs.Image

Note how the standard ROS messages are resolved to a Julia type, while topics with the non-standard type "dvs_msgs/EventArray" will be parsed as raw Array{UInt8,1}. See below to add support for non-standard types.

You can now read the messages in the bag:

>>> using RobotOSData
>>> @time bag[:] # read all messages
  2.655052 seconds (6.83 M allocations: 1.556 GiB, 8.31% gc time)
Dict{String,Array{T,1} where T} with 9 entries:
  "/davis/right/imu"         => MessageData{RobotOSData.CommonMsgs.sensor_msgs.
  "/davis/right/camera_info" => MessageData{RobotOSData.CommonMsgs.sensor_msgs.
  "/davis/right/image_raw"   => MessageData{RobotOSData.CommonMsgs.sensor_msgs.
  "/davis/left/camera_info"  => MessageData{RobotOSData.CommonMsgs.sensor_msgs.
  "/davis/right/events"      => MessageData{Array{UInt8,1}}[MessageData{Array{U
  "/davis/left/image_raw"    => MessageData{RobotOSData.CommonMsgs.sensor_msgs.
  "/davis/left/imu"          => MessageData{RobotOSData.CommonMsgs.sensor_msgs.
  "/velodyne_point_cloud"    => MessageData{RobotOSData.CommonMsgs.sensor_msgs.
  "/davis/left/events"       => MessageData{Array{UInt8,1}}[MessageData{Array{U

You can also read only some of the messages, which is faster than reading the whole file:

# read chunks 1 to 10:
>>> @time bag[1:10]
  0.016518 seconds (56.23 k allocations: 11.630 MiB)
# read a specific topic:
>>> @time bag["/davis/right/imu"]
  0.707286 seconds (3.60 M allocations: 244.969 MiB)
# read a time span:
>>> @time bag[ROSTime("2017-09-05T20:59:40"):ROSTime("2017-09-05T20:59:50")]
  0.317334 seconds (743.59 k allocations: 231.204 MiB)
# combine a specific topic and time span:
>>> @time bag["/davis/left/image_raw", ROSTime("2017-09-05T20:59:40"):ROSTime("2017-09-05T20:59:50")]
  0.116424 seconds (323.86 k allocations: 50.807 MiB)

Message Types

RobotOSData comes with parsers for the message types in the ROS packages std_msgs and common_msgs, and these are enabled by default. To disable them, use the following:

bag = load("indoor_flying1_data.bag"; std_types=[])

In the absence of a suitable parser, the message data will be read as raw bytes.

Writing new message types

If you want to support a new message type, for instance my_ros_pkg/NewMsgType, you can do so as follows:

bag = load("recording.bag", ExtraMessages)
module ExtraMessages
    module my_ros_pkg
        using RobotOSData.Messages # imports Readable, Header
        using RobotOSData.StdMsgs
        using RobotOSData.CommonMsgs # for sensor_msgs
        struct NewMsgType <: Readable
            header::Header
            imu::sensor_msgs.Imu
        end
    end
end

The parser will call read(io, NewMsgType) to deserialize the new type. Readable already provides a generic implementation of read that should be adequate in most cases. But you could also write your own read(io::IO, ::Type{NewMsgType}). Have a look at the read_field() methods here.

Auto-generating message types

RobotOSData provides a tool that lets you generate modules like the one above from the .msg files in a ROS package. To keep things simple, this tool does not try to resolve the dependencies between packages — it is up to you to indicate them. It will, however, handle dependencies between message files in the same package.

RobotOSData.gen_module(:ExtraMessages, ["path/to/my_ros_pkg"], "path/to/dest/dir",
    :(RobotOSData.StdMsgs), :(RobotOSData.CommonMsgs))