earth_rover_localization package from earth_rover_localization repo

earth_rover_localization

Package Summary

Tags No category tags.
Version 1.2.0
License BSD
Build type CATKIN
Use RECOMMENDED

Repository Summary

Checkout URI https://github.com/earthrover/earth_rover_localization.git
VCS Type git
VCS Version master
Last Updated 2019-03-07
Dev Status MAINTAINED
Released RELEASED

Package Description

Configuration for the EKF of the robot_localization package to use with the Earth Rover Open Agribot.

Additional Links

Maintainers

  • Andres Palomino
  • Ricard Pardell

Authors

No additional authors.

Earth Rover localization

This package contains ROS nodes, configuration and launch files to use the EKF of the robot_localization package with the Earth Rover Open Agribot. The package has been tested in Ubuntu 16.04.3 and ROS Kinetic. If you don't have ROS installed, use the following line.

$ sudo apt-get install ros-kinetic-ros-base

Dependencies

  • A summary description and links to the corresponding sites are listed below only if browsing further information is needed. The installation steps will download or include necessary configuration details on how to use the required dependences

robot_localization: Robot Localization is a collection of state estimation nodes, each of which is an implementation of a nonlinear state estimator for robots moving in 3D space. It contains two state estimation nodes, ekf_localization_node and ukf_localization_node. In addition, robot_localization provides navsat_transform_node, which aids in the integration of GPS data.

Piksy Driver: Driver compatible with the Swift Navigation devices.

xsense Driver: Driver for the third and fourth generation of Xsens IMU devices

GeographicLib: Offers C++ interfaces to a set of geographic transformations.

  • Dependency on host computer to monitor results.

Mapviz: Visualization tool with a plug-in system similar to RVIZ focused on visualizing 2D data.

Installation and Configuration

  1. On the on-board PC, create a workspace and clone the repository.
    $ mkdir -p ~/earth_rover_ws/src  
    $ cd ~/earth_rover_ws/src   
    $ git clone --recursive https://github.com/earthrover/earth_rover_localization.git

GeographicLib

  1. Download GeographicLib
    $ cd ~/earth_rover_ws
    $ wget https://sourceforge.net/projects/geographiclib/files/distrib/GeographicLib-1.49.tar.gz/download

  • Installation using CMAKE
  1. Unpack the source
    tar xfpz download

  1. then enter the directory created, create a separate build directory and enter it.
    cd GeographicLib-1.49 
    mkdir BUILD
    cd BUILD

  1. Run cmake, pointing it to the source directory (..)
    cmake ..

  1. Build and install the software. if CMAKE_INSTALL_PREFIX is a system directory
    make
    sudo make install

Further installing details can be found here

Robot_localization and Piksy RTK packages

  1. Install the robot localization package
    sudo apt-get install ros-$ROS_DISTRO-robot-localization

  1. Download ROS drivers for the Piksi RTK GPS module
    mkdir -p ~/earth_rover_ws/src/libs
    cd ~/earth_rover_ws/src/libs
    git clone https://github.com/earthrover/earth_rover_piksi

7.1 Checkout the new feature which is'n in the release yet (To test)

cd ~/earth_rover_ws/src/libs/earth_rover_piksi
git checkout feature_2.14.1     

Xsense

  1. Install the MTi USB Serial Driver
    $ cd ~/earth_rover_ws/src/libs/
    $ git clone https://github.com/xsens/xsens_mt.git
    $ cd xsens_mt
    $ make
    $ sudo modprobe usbserial
    $ sudo insmod ./xsens_mt.ko

  1. Install gps_common or gps_umd as available based on the ROS distributable
    $ sudo apt-get install ros-kinetic-gps-umd

or
    $ sudo apt-get install ros-kinetic-gps-common

  1. Download xsense ROS driver
    $ cd ~/earth_rover_ws/src/libs/
    $ git clone https://github.com/xsens/xsens_mti_ros_node

Compile

  1. Compile the packages
    $ cd ~/earth_rover_ws   
    $ catkin_make
    $ source devel/setup.bash

  • Drivers configuration to be performed on the embedded device.
  1. Configure the launch files for the package on each receiver (Reference and Attitude) according to the desired IP addresses. The configuration files can be found in earth_rover_localization/launch/piksi_multi_rover_reference.launch and earth_rover_localization/launch/piksi_multi_rover_attitude.launch respectively. This repository includes by default reference receiver ip_address to 192.168.0.222 and attitude receiver ip_address to 192.168.0.223

Check the <arg name="interface" is set to default="tcp" and change the desired tcp_addr if necessary.

<!-- If interface is tcp, this specifies the address of Piksi Multi. -->
<arg name="tcp_addr"                    default="192.168.0.222"/>

  1. The ROS node reads SBP (Swift Navigation Binary Protocol) messages, a fast, simple, and minimal overhead binary protocol for communicating with Swift Navigation devices.

Please check here which Piksi Multi firmware version based on the current SBP Lib version.

Currently the scripts/install_sbp.sh will install SBP Lib 2.4.1. This means you are supposed to install Firmware 2.1.14 from SwiftNav Firmware page in your Piksi Multi. WARNING: If upgrading from a firmware below v2.0.0 to a firmware greater than v2.0.0, you must upgrade to v2.0.0 first.

WARNING: install ONLY ONE version of SBP library, depending of which Hardware version you are using.

The following code will automatically download the required version of libsbp and install it in the default folder /usr/local/lib/python2.7/dist-packages/sbp-<SBP_LIB_VERSION>-py2.7.egg/sbp/.

# To install SBP, Execute this line in the package folder 'earth_rover_localization'
source scripts/install_sbp.sh

Check that the installations finishes succesfully. If any error appears due to locale settings, check the following solution and try the SBP installation again.

  1. To configure the ENU results from the ROS driver, fill the enu_origin.yaml on the package folder earth_rover_localization/cfg with the same location of the base station. If base station is not yet configured, remember to edit this file before launching earth_rover_localization

Hardware configuration

The following steps explain the Hardware and ROS drivers configuration to run in the embedded device and monitor on a host PC. Only follow this section if the required sensors are available to test for a complete base station - rover setup. Skip to Earth Rover localization to see robot localization node, visualization tool and play recorded results.

Piksy Modules

The Hardware configuration uses three Piksi Multi Evaluation Board: A base station and two receivers on the rover (reference and attitude).

The reference receiver obtains corrections from base station using the FreeWave Radio Evaluation Kit and then send corrections to the attitude receiver which enables precise heading output.

  • Swift console on a host computer
  1. Follow the instructions on installing and operating the Swift Console on your computer, see the Installation Instructions and User's Guide.
  • Use the following steps to configure the Piksy modules.
  1. Complete the instructions to configure the base station and rover receiver to use the GNSS RTK Position with Stationary Base solution.

  2. Follow the configuration to enable the heading setup. Use the piksis on the rover to configure this step. WARNING Be aware that one receiver (reference receiver) has already be configured to receive corrections from a base station. Configure the enabled_sbp_messages on uart1 instead to send corrections from reference to attitude through this available port. See the documentation details.

  1. Enable the Ethernet Configuration on reference and attitude receivers based on the desired IP addresses to connect.

Usage

  1. Test the ROS node on the reference receiver. The following line will launch the configuration over TCP/IP. Check that observations are received on the Swift Console and also the published topics from the driver
    $ roslaunch earth_rover_localization piksi_multi_rover_reference.launch

  1. Test the ROS node on the attitude receiver. Check again observations and topics specially the /piksi_attitude/baseline_heading
    $ roslaunch earth_rover_localization piksi_multi_rover_attitude.launch

  1. Test the xsense node and check the publised topics.
    $ roslaunch earth_rover_localization xsens.launch

  1. The complete launch can be used to include sensor drivers and robot localization node to estimate the robot's pose in real time.
    $ roslaunch earth_rover_localization er_localization_rover.launch

Earth Rover localization

Robot localization package

If not already installed, install the robot localization package

$ sudo apt-get install ros-$ROS_DISTRO-robot-localization

The package includes .bag example files of recorded tracks to run robot localization and tune the EKF params if necessary. The following launch file reproduces a bag file and applies the robot localization to adquire the pose estimation of the rover.

$ roslaunch er_localization er_localization_player.launch

The result of the localization package is the robot's pose estimation in its world frame. Then, the origin of the world frame is georeferenced and will change depending on where the scouting mission is performed.

The launch will find the coordinates of the base station to set the origin of the Map frame. Check the enu_origin.yaml on the package folder earth_rover_localization/cfg. Only if you're using the bag player, set the following location on the configuration file.

latitude0_deg: 41.4678702
longitude0_deg: 2.0227646
altitude0: 133.0527

Inputs

The main published topics are: - /mti/sensor/imu: A sensor_msgs/Imu.msg with the imu data - /heading: A sensor_msgs/Imu.msg which reports the vehicle heading reported by the baseline between reference and attitude receiver - /piksi_receiver/navsatfix_best_fix: A sensor_msgs/NavSatFix.msg that contains WGS 84 coordinates with best available fix at the moment (either RTK or SBAS)

Nodes

Used nodes on the architecture - heading_listener: In charge of traducing the vehicle heading from the baseline into ROS-compliant message to use in robot localization node - set_datum: Finds the convergence value of the desired start location in enu_origin.yaml. It's necessary to set the map's origin. - navsat_transform: Takes as input the GPS data and produces an odometry message in coordinates that are consistent with the robot’s world frame. More info about navsat_transform_node on Documentation. - ekf_localization: The node is an implementation of an Extended Kalman filter. It uses an omnidirectional motion model to project the state forward in time, and corrects that projected estimate using perceived sensor data. Detailed information on the Documentation page.

Outputs

  • /odometry/gps: A nav_msgs/Odometry.msg message containing the GPS coordinates of your robot, transformed into its world coordinate frame.
  • gps/filtered: A sensor_msgs/NavSatFix.msg message containing your robot’s world frame position, transformed into GPS coordinates.
  • /odometry/filtered/global: A nav_msgs/Odometry.msg message with the robot's pose estimation in its world frame.

Mapviz (Optional) on host PC

The idea of this step is to start a ROS system using two machines and monitorize the master on the embedded PC from a host PC. Host PC and embedded PC should be connected on the same network. Get involve with working with multiple machines and the environmental variable ROS_MASTER_URI here

You can install mapviz using apt-get from the ROS apt repository:

$ sudo apt-get install ros-$ROS_DISTRO-mapviz ros-$ROS_DISTRO-mapviz-plugins ros-$ROS_DISTRO-tile-map ros-$ROS_DISTRO-multires-image

Go to this tutorial to enable ROS Offline Google Maps for MapViz

  • Go to the downlodaded package and edit the launch file
$ roscd mapviz
$ cd launch/
$ sudo nano mapviz.launch

  • Replace the file with the following template for mapviz.launch Edit the local_xy_origins with the base station location
<?xml version="1.0"?>

<launch>

  <!-- Mapviz -->
  <arg name="print_profile_data" default="true"/>

  <node pkg="swri_transform_util" type="initialize_origin.py" name="initialize_origin" output="screen">
    <param name="local_xy_frame" value="map"/>
    <param name="local_xy_origin" value="swri"/>
    <rosparam param="local_xy_origins">   # Replace with Map origins. Same as robot localization datum param
      [{ name: swri,
      latitude: 41.4678702,
      longitude: 2.0227646,
      altitude: 132.530939,
      heading: 0}]
    </rosparam>
  </node>  

  <node pkg="mapviz" type="mapviz" name="mapviz"></node>

 </launch>

  • launch mapviz
$ roslaunch mapviz mapviz.launch

  • Download the config file from this repository, cfg/mapviz_localization_config.mvc, go to File -> Open Config on the top bar and upload the configuration file.

  • Visualization of topics should appear to follow the localization task.

CHANGELOG

Changelog for package earth_rover_localization

1.2.0 (2019-03-05)

  • Update readme and install SBP script
  • Fixed piksi package in launch and install targets
  • Contributors: Andres Palomino

1.0.1 (2019-02-07) -----------* Update dependencies * Contributors: Andres Palomino

1.0.0 (2019-01-28) -----------* Update CMakeList.txt GeographicLib test * Update package.xml build depend * changing package name in launch file * adding dockerfile and docker-compose * Fix package name and update Readme * Contributors: Andres Palomino, Paul Harter

Wiki Tutorials

See ROS Wiki Tutorials for more details.

Source Tutorials

Not currently indexed.

Dependant Packages

No known dependants.

Launch files

  • launch/piksi_multi_rover_reference.launch
      • interface [default: tcp]
      • baud_rate [default: 115200]
      • tcp_addr [default: 192.168.0.222]
      • base_station_ip [default: 192.168.0.1]
      • load_enu_origin_from_file [default: true]
      • enu_origin_file [default: $(find earth_rover_localization)/cfg/enu_origin.yaml]
  • launch/imu_piksy_drivers.launch
    • EarthRover Localization This file includes nodes to launch Piksy driver, Xsense driver
  • launch/piksi_multi_rover_attitude.launch
      • interface [default: tcp]
      • baud_rate [default: 115200]
      • tcp_addr [default: 192.168.0.223]
      • base_station_ip [default: 192.168.0.1]
      • load_enu_origin_from_file [default: true]
      • enu_origin_file [default: $(find earth_rover_localization)/cfg/enu_origin.yaml]
  • launch/er_localization_set_datum.launch
    • EarthRover Localization Reads location from yaml file to update ENU origin of map, location and convergence value Author: Andres Felipe Palomino (apalomino@edgebrain.io)
      • enu_origin_file [default: $(find earth_rover_localization)/cfg/enu_origin.yaml]
  • launch/xsens.launch
  • launch/er_localization_viztools.launch
      • print_profile_data [default: true]
  • launch/er_localization_rover.launch
    • EarthRover Localization This file includes nodes to launch Robot localization Author: Andres Felipe Palomino (apalomino@edgebrain.io)
  • launch/er_localization_player.launch
    • EarthRover Localization This file includes nodes to launch Robot localization Author: Andres Felipe Palomino (apalomino@edgebrain.io)
      • path [default: $(find earth_rover_localization)/bag_files/piksi-multi-debug-2018-12-05-15-42-46.bag]

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged earth_rover_localization at answers.ros.org