This package explains how to configure your system and ROS to use the Argos3D P100 ToF camera. The package includes an example allowing you to visualize images using the rviz viewer included in ROS. It demostrates how to use the camera within ROS and the different parameter configurations of the P100 as well as its capabilities.
To get more information about the Time of Flight camera Argos3D P100 please visit Bluetechnix website: http://ww2.bluetechnix.com/en/products/depthsensing/product/argos3d-p100/
The argos3d_p100_ros_kg works with ROS versions groovy and hydro. You can use catkin workspaces or the previous rosbuild to configure, compile and get ready ROS.
We will point in the above lines how to get ros_hydro and catkin workspace ready from the tutorials of the ROS web site.
In Ubuntu follow the ROS installation tutorial:
Why to use catkin workspaces:
To configure a catkin workspace in your ROS installation, follow this:
ROS tutorial: http://wiki.ros.org/ROS/Tutorials/InstallingandConfiguringROSEnvironment
Be sure your libboost library version is >= 1.49. Previous versions as 1.46 generate errors while compiling argos3d_p100-ros-pkg.
The first step is to add the PMDSDK to our system. (The PMDSDK is copyrighted software and it is distributed with your Argos3D P100)
After unziping the software distributed with your Argos3D P100 camera, browse to the directory of your operating system version.
Install the driver for using the ToF camera:
In Ubuntu/linux copy the file from the driver folder to /etc/udev/rules.d/
cd driver
sudo cp 10-pmd-ubuntu.rules /etc/udev/rules.d/
This will set the right permissions to allow not sudo users to use the camera.
Add PMDSDK to your system (use the right version for your system 32 or 64 bits).
You have different ways to add it to the LD_LIBRARY_PATH.
#PMD camera support
/.../PMDSDK/bin
/.../PMDSDK/include
replace the dots with the absolute path to the PMDSDK directory
After adding libraries, update the links and cache of the share libraries with:
ldconfig
Make sure you have the following dependencies already installed:
apt-get install ros-hydro-pcl-ros ros-hydro-pcl-conversions ros-hydro-perception-pcl
Clone from repository: https://github.com/voxel-dot-at/argos3d_p100_ros_pkg.git to your src/ folder in your catkin workspace. and compile it with:
cd catkin_ws
source devel/setup.bash ## initialize search path to include local workspace
cd src/
git clone https://github.com/voxel-dot-at/argos3d_p100_ros_pkg.git
cd ..
catkin_make
roscore &
cd catkin_ws
source devel/setup.bash
rosrun argos3d_p100 argos3d_p100_node
You can change the camera parameters through command option when initializing the node
Use --help parameter to display parameter initialization usage
Using help for argos3d_p100_ros_pkg
You can set default configuration values for the camera with the following options:
Usage:
rosrun argos3d_p100 argos3d_p100_node
-it *Integration_Time*
Integration time(in msec) for the sensor
(min: 100 | max: 2700 | default: 1500)
-mf *Modulation_Frequency*
Set the modulation frequency(Hz) of the sensor
(min: 5000000 | max: 30000000 | default: 30000000)
-bf *Bilateral_Filter*
Turns bilateral filtering on or off
(ON: if set | OFF: default)
-fr *Frame_Rate*
Set the frame rate of the camera by setting the Phase Time (Please be careful when setting values higher than 40 FPS without using an extra cooling system. The camera can stress by overheating and be damaged).
(min: 1 | max: 160 | default: 40)
-flip_x *flip_x*
Flip images in the x coordinate.
(ON: if set | OFF: default)
-flip_y *flip_y*
Flip images in the y coordinate.
(ON: if set | OFF: default)
-af *Amplitude_Filter_On*
Whether to apply amplitude filter or not. Image pixels with amplitude values less than the threshold will be filtered out
(ON: if set | OFF: odefault)
-at *Amplitude_Threshold*
What should be the amplitude filter threshold. Image pixels with lesser aplitude values will be filtered out. Amplitude Filter Status should be true to use this filter
(min: 0 | max: 2500 | default: 0)
Example:
rosrun argos3d_p100 argos3d_p100_node -it 1500 -mf 30000000
In the software distibuted with your camera there is a calibration file that provides precise 3D position calculation. The file is load when the connection with you Argos3D is established.
In order to use it, just copy this file to the folder where you will execute the node:
cp argos3d.cal catkin_ws
cd catkin_ws
rosrun argos3d_p100 argos3d_p100_node
The argos3d_p100_node will show a message that confirmes you if the calibration file was loaded successfully.
rosrun rviz rviz
After the rviz window comes up, set the following options
Add a Pointcloud2 topic to visualize the depth clouds. Two different point sets are published with following topic names:
- /depth_non_filtered : raw data from the pmd camera.
- /depth_filtered : after applying amplitude threshold, if selected.
To do this please perform the following steps:
To apply point filters and change camera parameters, use dynamic_reconfigure from ros. To use, it run the configuration interface (after launching argos3d_p100_ros_pkg)
rosrun rqt_reconfigure rqt_reconfigure
Select /argos3d_p100 to view the options available for modifications.
Following camera parameters and filtering methods can be accessed using the dynamic reconfigure