Awesome
ViconMAVLink
ViconMAVLink is an application to provide indoor positioning for networked robots using Vicon motion capture measurements. It is primarily used in the Intellegent Robotics Lab at the University of Illinois as a tool to simulate indoor GPS for Linux-based autonomous vehicles, such that you can operate autonomous vehicles indoors:
A fleet of UAVs flying with simulated GPS:
<img src="figs/launching.gif" width="600" align="center">Heterogeneous autonomous vehicles controlled via tablet groundcontrol:
<img src="figs/indoorGPS.gif" width="600" align="center">Dependencies
ViconMAVLink uses the following libraries:
- Vicon DataStream SDK: to obtain real-time, high-precision positioning measurement for objects.
- MAVLink library: to encode/unpack UDP data with the MAVLink protocol.
- GeographicLib: to convert positioning data between local coordinates and GPS locations.
- QT5 (core gui widgets network concurrent): to provide a GUI, networking and multithreading.
As long as you have all required libraries added to the Qt project file. This application can be built for multiple platforms in QtCreator.
User's Guide
You can run this app directly on the Vicon server computer or on any other computers as long as they are in the same network as the Vicon server computer. After you launch the application, the main window will appear. But, the capture objects list is empty because you haven't connected to Vicon yet.
- The
HostAddress
is the IP address of the Vicon server computer. - The
HostPort
usually is801
. This is the port used by Vicon. - The
North
mapping: Vicon uses a Forward-Left-Up coornidates while theLOCAL_POSITION_NED
message in MAVLink uses North-East-Down, to make the situation more confusing, GeographicLib uses a East-North-Up coordinates. To convert position data correctly, you need to map your Vicon axis first. Assuming you calibrated Vicon according to the manual, just choose the correct half-axis that corresponds to North then this app will handle the mapping correctly.
To connect to Vicon: Click Menu
->Connect Vicon
then objects that are captured by Vicon will appear in the Captured Objects List.
To launch a sender for a robot: Choose an object then Click Start a MavLink Sender
, the Sender's window appears. After you start sending data, the Rate
slider is still adjustable to change the sending rate on-the-fly.
You may launch multiple senders for a fleet of robots:
<img src="figs/fleet.gif" width="400">Developer's Guide
The Station object will launch a separate thread to communicate with Vicon. A Writer/Reader lock is used to synchronize data. The Station object is the writer and Sender objects are the readers who fetch raw measurement from the Station. The raw measurement includes position (unit: mm) and a quarternion encapsulated in a mavlink_att_pos_mocap_t
object. Since Vicon does not output velocities, the Sender uses a linear Kalman filter to compute a mavlink_local_position_ned_t
object with positions and velocities. The GPS_HIL
data is then computed with the local position object. The Station and Sender objects and windows use the Model-View-Controller pattern.