3. Problem domain: Traffic network of Dubins cars¶
Often referred to as “the second domain,” the basic setting is navigation in a small network of roads with vehicles that follow unicycle-like dynamics.
While below we include pointers to the main websites for dependencies, many are available via packages for your OS and may already be installed, especially if you have ROS on Ubuntu 14.04. Supported platforms are described in the Introduction.
There are two major variants of this benchmark: one based in simulation and another on a physical testbed. We begin with preparations appropriate for both.
On Ubuntu, Eigen can be obtained by installing the “libeigen3-dev” deb package (https://packages.debian.org/jessie/libeigen3-dev).
Several ROS packages for the Kobuki by Yujin Robot are required.
fmrb from your copy of the repository, e.g.,
cd tools/fmrb-pkg pip install -e .
or get it from PyPI,
pip install fmrb
3.1.3. Dependencies of the physical variant¶
In the below code,
$FMRBENCHMARK is the absolute path to a copy of the
fmrbenchmark repository on your machine.
3.2.1. Launching a problem instance of the simulation variant¶
Create a catkin workspace.
mkdir -p dubsim_workspace/src cd dubsim_workspace/src catkin_init_workspace
Create symbolic links to the ROS packages in the fmrbenchmark repository required for this example.
ln -s $FMRBENCHMARK/domains/dubins_traffic/dubins_traffic_msgs ln -s $FMRBENCHMARK/domains/dubins_traffic/dubins_traffic_utils ln -s $FMRBENCHMARK/domains/dubins_traffic/dub_sim ln -s $FMRBENCHMARK/domains/dubins_traffic/e-agents/wander
Build and install it within the catkin workspace.
cd .. catkin_make install
Because the installation is local to the catkin workspace, before beginning and whenever a new shell session is created, you must first
source command assumes that you are using the Z shell; try
setup.bash if you use Bash.
python $FMRBENCHMARK/domains/dubins_traffic/trial-runner.py -f mydata.json $(rospack find dubins_traffic_utils)/examples/trialsconf/mc-small-4grid-agents2.json
This will cause trial data to be saved to the file
mydata.json in the local directory from where the above command is executed.
The Gazebo server is launched without a GUI frontend, which is also known as running headless. A local viewer can be launched using
The vehicle to be controlled has the ROS namespace
/ego. The e-agents have
namespaces defined in the trials configuration file. In the example
mc-small-4grid-agents2.json used in this tutorial, these are
In a separate terminal, run your controller. For example, assuming your controller is contained in the package your_controller with launch file foo.launch, in a separate terminal, run
roslaunch your_controller foo.launch