Multi Agent NMPC for Active Information Acquisition wiki¶
This wiki is not entirely up-to-date, but will be very soon.
In case of a question, query, comment, or bug report, feel free to use the issues system or contact the corresponding author Martin Jacquet - email@example.com.
The framework has been written and tested using Ubuntu 18.04 since it is the OS used by the LAAS-CNRS robotic platform. It should work seamlessly on a recent Linux version, but there is no guarantee.
Some issues have been found while installing the software on Ubuntu 16.04 because of version incompatibility with Protoc and Protobuf.
The installation on a non-Linux OS has to be handled by the user.
The installation assumes the use of a package manager (e.g.
apt) to install some dependencies, as well as the Gazebo simulator. Everything provided in this repo or by the LAAS-CNRS robotic platform aims to be installed locally in the repository folder to avoid polluting the user's system.
I - Software Overview¶
Collections of all the open-source software used at LAAS. You can find more details in Openrobots Wiki-Homepage
Robotpkg is a packaging system for installing robotics software developed by the robotic community.
We will use robotpkg to install the required modules for the simulations (state estimation, gazebo interface...) as well as third-party dependencies (qpOases).
GenoM is a generator of modules, designed to be middleware independent, i.e. the same module can be compiled for, e.g., ROS, YARP, or Pocolibs, without any modification.
This allows a great code re-usability and abstracts the user from any specific choice of middleware.
Originally GenoM has been developed tightly with Pocolibs, then from version 3, aka GenoM3, ROS templates have been provided.
Another specificity of GenoM is the interaction with and between components.
Each component is started independently like a Linux executable (within a roscore, for ROS, or an h2 instance, for Pocolibs), then the connection between ports (or topics) is made using a supervisor, Genomix, either with Matlab or TCL.
Pocolibs is a middleware, like ROS.
It aims at being lighter and faster than ROS, when running on a single machine, thanks to the exploitation of shared memory. ROS, on the other hand, uses a network layer for sending messages between nodes, this leads to greater delays and loss of performance.
I-5. TeleKyb¶The TeleKyb software platform provides the aerial-robotic oriented software developed at LAAS-CNRS.
In particular, we will use:
- mrsim, a Multi-Robot SIMulator. It is designed to be a transparent interface w.r.t. the real aerial vehicles used in LAAS-CNRS. It makes the transition between simulation and experiments transparent, from the software point of view.
- pom, a UKF-based state estimator merging state feedback for different sources (e.g. mocap + IMU)
- optitrack, to export the motion capture data to the genom software stack
- rotorcraft, the low-level interface, with either the simulated or real platform
- nhfc, near-hovering flight controller, used for unmodeled take-off and post-failure recoveries
- maneuver, a global trajectory planner, providing position and attitude (as quaternions) as well as first and second derivatives. It implements take-off and waypoint-to-waypoint motions.
I-6. Gazebo¶To simulate the platform, we use the Gazebo simulator. To interface it with the genom software stack, we use two dedicated components:
- mrsim-gazebo a plugin to interface the simulated multi-rotor with the genom components (in place of mrsim)
- optitrack-gazebo emulates the optitrack network interface to publish the model poses
The installation procedure for Gazebo can be found at http://www.gazebosim.org/tutorials?cat=install&tut=install_ubuntu&ver=9.0
II - Installation procedure¶
This section is a tutorial on how to install the software architecture to run the simulations.
II-0. Clone the Perceptive and torque-control NMPC repository¶
Clone the repo associated to this project. Its root will act as the devel folder for the following.
git clone git://redmine.laas.fr/laas/perceptive-torque-nmpc.git
To simplify the installation, we provide some environment variables in the
In order to run all the installed executables, we need to set up the path to the newly created folders.
We provide a
env.sh script that exports all the required variables.
/!\ the source has to be called in the repository root since it uses the
pwd command to export the paths.
II-1. Setup robotpkg¶
(Steps taken from http://robotpkg.openrobots.org/install.html)
1. Clone the robotpkg lastest release:¶
git clone git://git.openrobots.org/robots/robotpkg
2. Check that the
openrobots/ folder exists in the repository root, and update the environement variables accordingly if you didn't source the
3. Install robotpkg¶
4. Install the required components and their dependencies¶
The installation can be done 'manually' by navigating to the desired folder in
./robotpkg/ and installing with
make update; but we will simplify the process using a set.
To do so, we need to edit the config file:
$ROBOTPKG_BASE/etc/robotpkg.conf. Add the following at the end of the file:
PKG_OPTIONS.%-genom3 = \
PKGSET.mpcset = \
PREFER.lapack = robotpkg
PREFIX.matlab = <path/to/Matlab>
The last line needs to point to the Matlab root folder in the system (e.g.
It is recommended to use Matlab for the proposed simulations since the syntax is more intuitive and comprehensible for the user to modify. However, we also provide all the launch files in TCL, as well as the environment to run them (
shell/eltclsh in the above list is a custom TCL script shell).
If Matlab is not installed on the system, remove the lines
supervision/matlab-genomix \ and
PREFIX.matlab = <path/to/Matlab> from the above list.
Also, all the above is meant for using Pocolibs, not ROS. Futur version of this tutorial might come to use the ROS install.
Now return to the robotpkg folder and install all the set:
During the installation, some required dependencies need to be installed with the usual package manager (e.g.
apt on Ubuntu). When the install stops, install the required packages and rerun the above command.
5. Matlab configuration¶
The last step is to update the Matlab path to use the custom libraries, if relevant.
Add the following paths in the Matlab path window:
(change </path/to/openrobots> to the value of
II-2. Install custom components¶
List of the components¶The
src/ folder contains some additional components, in particular:
- vision-idl: the type declarations regarding the camera modules
- camgazebo-genom3: read the data from the gazebo innate cameras, via the gazebo API
- camviz-genom3: record and/or display the images from a camera
- arucotag-genom3: detect and the ArUco markers
- ikf-genom3: an implementation of the intermittent Kalman filter presented in the paper
- uavmpc-genom3: the NMPC controller presented in the paper
- tagcontrol: both a Gazebo plugin and a genom component that work together to move the ArUco tags in the Gazebo world
Install the extra components¶
Since they are not considered 'stable' as the one provided in robotpkg, we rather install them in a devel folder.
Go to the project root, check that the devel folder exists, export the path if you didn't source the
env.sh. Then go to the sources folder:
For the manual installation,
asciidoctor is needed. It can be installed using
apt or any package manager.
Each component here has to be installed manually, using
autoconf. To do so, proceed as follow:
../configure --prefix=$DEVEL_BASE --with-templates=pocolibs/client/c,pocolibs/server
vision-idl has to be installed first since it defines some type headers used by others.
The installation of the main component,
uavmpc-genom3, is described in the next subsection.
Install the MPC controller¶
Before installing the MPC controller, we have to generate the
C sources corresponding to the desired model.
To do so, go to the
There is a README.md file there, explaining the requirements.
In short, the model sources are exported to
python3 along with
CasADi are required, and easily installable on most Linux distributions (e.g. with
Then, the sources are generated using:
python3 gen_model.py <quad or hexa>
Then install the component as explained before, but add the following flags to the
configure --prefix=$GENOM_DEVEL --with-templates=pocolibs/client/c,pocolibs/server CPPFLAGS="-Wall -march=native -mfpmath=sse -I$ROBOTPKG_BASE/include" CXXFLAGS="-O3" CFLAGS="-O3" LDFLAGS="-L$ROBOTPKG_BASE/lib -Wl,-R$ROBOTPKG_BASE/lib"
Inside each model file, the variable
number_agents (l. 36) can be changed to specify the number of UAVs in the system. This is needed to define the size of the parameter matrix (containing the other agents' variables).
II-3. Setup the environment¶
In order to run all the installed executables, we need to set up the path to the newly created folders.
All the required variables are exported in the
III - Running the simulation¶
ws/ folder contains all the material to run a basic simulation with the NMPC.
In a terminal, launch the
launch_mpc.sh script. It takes 1 argument, being the number of UAVs. It starts all the Genom components, in the background. It is used as a console since it displays warnings or errors during runtime.
In another terminal, start gazebo with one of the world files provided.
eltclsh and go to the relevant subsection below.
III.1. Running the simulations with Matlab¶
Change the flag at the top of the script to use either the quadrotor or the hexarotor.
The provided scripts are organized as follow
param_*.mscripts provide the parameters for either a standard colinear quadrotor (denoted QR) or a tilted-propeller hexarotor (denoted tx).
init.mscript that connects all the components together and calls the initialization services for all provided components.
traj_*.mthat runs the specific trajectories for a specific scenario.
Run the init script and wait until it stops displaying in the console.
If no error occurred, run any traj script then press enter between each step to proceed to the next one. The evolution can be watched in gazebo and in the console terminal in parallel.
The init.m script contains some parameters at the top of the script, in particular, n_UAV. It will specify the number of UAVs to initialize.
III.2. List of the provided trajectories¶
traj_mpc_1/2/3.m files respectively correspond to the number of UAVs to use.
III.3. Comments on how to use the simulator¶
- The MPC weights and parameters can be tuned in the
- The marker can be moved, either using a joystick or manually, using the interface of the tagcontrol component.