Mudanças entre as edições de "Running Carmen"

De LCAD
Ir para: navegação, pesquisa
(Running it All Together)
(Interface Modules)
Linha 178: Linha 178:
 
This will open a graphic display. Place the simulated robot in the map by left-clicking on the "Place Simulator" button, and then left-clicking once on the desired location on the map. Then move the cursor away from the blue dot that appears, in the direction you wish the robot to face. A blue line appears between the cursor (now two curved arrows) and the simulated robot, indicating the facing of the robot. Left-click again to fix the facing of the robot.
 
This will open a graphic display. Place the simulated robot in the map by left-clicking on the "Place Simulator" button, and then left-clicking once on the desired location on the map. Then move the cursor away from the blue dot that appears, in the direction you wish the robot to face. A blue line appears between the cursor (now two curved arrows) and the simulated robot, indicating the facing of the robot. Left-click again to fix the facing of the robot.
  
[[imagem:carmen-planner.png]]
+
[[imagem:200w_d.gif]]
  
 
Viewer 3D
 
Viewer 3D

Edição das 15h43min de 11 de outubro de 2017

Introduction

This document is an aid to begin using the CARMEN robot sensing and navigation software, including (but not limited to) the following programs:

This program stores sensor and odometry data with time stamps into a log file.

  • playback

This program plays back a log file and send the stored messages to the other modules.

This program allows for creating or editting maps for use by Carmen.

This program provides a graphic interface which shows the robot's position and destiation on the pre-built map and allows setting of the current position and orientation, and selection of destinations.

  • param_edit

This program enables the user to change parameters as the robot is running. It also makes it easy to save the changes to a ".ini" file.

  • param_deamon

This program provides other programs with information about the robot being used and the area around it. This can include a pre-built map, sensors on the robot, and typical sensor error.

  • robotgui

This program provides a simple graphic interface for the robot, allowing direct motion control and a display of current sensor information.

  • processcontrol

This program controls the different processes, restarts them in case of a crash, etc.

  • simulator

This program provides simulated data generation from a virtual robot. It requires a previously generated map.

  • base_services

This program controls the movement of the robot and accepts inputs from the sensors. This program MUST run on the computer attatched to the robot hardware.

  • localize

This program uses the sensor information from the baseServer to find the robot position in a map provided by param_deamon.

  • navigator

This program enables autonomous navigation.

  • vasco

This program creates a map from sensor and odometry data stored in a log file.

  • vasco-tiny

A command line scan-matcher based on vasco. It reads log files and outputs a (locally) corrected log file.

The links above will go to other pages with more complete descriptions and instructions for using these programs.

The "central" program, IPC, enables communication between these and other programs. Information on using and coding with IPC can be found at http://www-2.cs.cmu.edu/afs/cs/project/TCA/www/ipc/ipc.html. A simplistic explanation of IPC: various programs "publish" generated information which is then "subscibed to" by other programs. IPC keeps track of what is published and delivers it to the subscribers.

Carmen use Scenaria

The use of CARMEN will described using three different scenaria: simulating a robot and way-point navigation of it in a known map, tele-operating a robot, and building a map. Since CARMEN is modular software, each scenario will involve opening a bunch of different xterms and running different programs (called modules in the LCAD version of Carmen). Alternatively, one can use the program proccontrol to start and control each module.

Before starting, go to the Carmen sub-directory carmen/bin.

Running a Simulated Robot

In this section you will learn how to run a simulation of the autonomous driving car from IARA project. Just follow the steps bellow to understand how each of the modules are initialized for this task.

The modules shown in this tutorial may be replaced, as the project is still in developpement. So we encourage you to check the 'process-navigate-volta-da-ufes-pid.ini' file. There you will see every module been used by this process (that is usualy the most update one).

To run the simulation just do:

  cd $CARMEN_HOME/bin/
  ./central

And then, in another tab in the bin/ directory:

  ./proccontrol process-navigate-volta-da-ufes-pid.ini

This will run all the commands automatically.


Central notes

If the central server is already running, you might receive the message:

  Error: unable to bind TCP/IP socket for listening

You can check if the server is running using the command:

  ps -a | grep central

If there is a server running you will receive a message like this:

  6446 pts/0    00:00:00 central

You can kill a running central using:

  killall central

If you are running programs on multiple machines, then you must specify on the other machines which machine is running central. This is done with the bash command:

  export CENTRALHOST=[hostname]

where [hostname] is the name of the machine on which central is running.

Note: When running displays on off-robot computers, running the display programs off-robot rather than on-robot uses less bandwidth than piping the X display across the network.

Parameters Server

  ./param_daemon ../src/carmen-ford-escape.ini

The command above will start the param_deamon such that read the parameters for LCAD's robots and modules from the parameter file "carmen/src/carmen-ford-escape.ini". Some of the parameters contained in "carmen-ford-escape.ini" are informations about the localization, mapping and odometry modules, as well as the geometry of the sensors and the car it-self.

Other command-line options are:

  • [map_filename] Opens the map to get some information about it
  • robot [robotname] directs the server to parameters specific to the robot which should exist in the specified parameter file.
  • [mapfile.map] directs the server to a map file specific to the location. If you do not specify a mapfile, then no map will be served.
  • [paramfile.ini] specifies a parameter file. If no file is specified, then parameters from carmen.ini will be used. The param_deamon will look first in the current directory, then the parent directory (../), and then ../src/ for carmen.ini.
  • [-port portnum] specifies a port to be used for an ANT server
  • [-noant] says not open an ANT server
  • [-useant] says to use an ANT server

Proccontrol GUI

Command:

  ./proccontrol_gui

The command above will open an interface where you can easily monitor the modules running for this simulation. As you run other modules, their names will apear in the screen.

Map Server

  ./map_server -map_path ../data/map_ida_guarapari-20170403-2 -map_x 7756892.9 -map_y -364045.2 -block_map on  -lanemap_incoming_message_type 0

The map_server program will load the car's poses and the OFFLINE map from the informations contained in ../data/map_ida_guarapari-20170403-2 directory. The OFFLINE MAP serves as reference to the localisation system of the car.

Essential command-line options:

  • -map [map-file]  : Load an offline map from the [map-file].
  • -map_path [path]  : Enter the path to the offline map directory.
  • -map_x [float]  : map's x global position.
  • -map_y [float]  : map's y global position.
  • -block_map ['on'/'off'] : enable the generation of the map with the data inside the [path] directory.

Simulator Module

  ./simulator_ackerman

This command will start a moderately useful 2-D simulator, intended to replace the base module. It publishes odometry, laser messages and sonar messages. It accepts base velocity commands. The simulator always starts with its robot in the bottom right corner of the map (0,0), but subscribes to localize_initialize messages as well as simulator_set_truepose messages to initialize its robot position.

The simulator can also run an instance of the robot module to provide collision prevention. This, however, needs to be activated in the ini file using the parameter "simulator_use_robot". This parameter is disabled by default, which means that you have to start the module robot separately.

Slam modules

  ./localize_ackerman -mapping_mode off &
  ./mapper -map_path ../data/mapper_teste -map_x 7756450 -map_y -364200 &
  ./obstacle_distance_mapper

The localize module is the original Carmen localization program using a particle filter. It can perform global localization and pose tracking. Localize uses a set of parameters that (strongly) influence the robustness and performance of localize. This is mainly the observation likelihood model and the noise in the motion model. You will find those parameters as expert parameters in the `carmen-ford-escape.ini` file. In this case we use the '-mapping_mode off' command-line option because we are not generating an offline map from sensor logs.

The mapper module updates the offline map loaded from the map_server module with real-time information (moving objects, people, etc).

RDDF Module

RDDF stands for Road Data Definition file.

  ./rddf_play ../data/rndf/rddf-voltadaufes-20170809.txt ../data/rddf_annotation_log_20140418.txt

This program will create a file that contains pose informations (position and angles) about a previous driven ride. This will be a reference to the rigth path inside the road to the car when in autonomous mode.

Behavior Selector

  ./behavior_selector

As the name suggest, this program will choose the rigth behavior in each different situation detected by other modules.

Motion Control Module

Model predictive planner

  ./model_predictive_planner

This module outputs the aceleration of the car based on the next position desired.

Path planner

  ./rrt_path_follower

The path planner module tries to reduce the latency between sensoring and atuation on the system.

Obstacle avoider

  ./obstacle_avoider

Generate alternative paths to avoid obstacles.

Interface Modules

Navigatorgui

  ./navigator_gui2 -map_path ../data/map_ida_guarapari-20170403

This will open a graphic display. Place the simulated robot in the map by left-clicking on the "Place Simulator" button, and then left-clicking once on the desired location on the map. Then move the cursor away from the blue dot that appears, in the direction you wish the robot to face. A blue line appears between the cursor (now two curved arrows) and the simulated robot, indicating the facing of the robot. Left-click again to fix the facing of the robot.

200w d.gif

Viewer 3D

  ./viewer_3D

This will open a 3D graphic interface where the car movement and sensors data are displayed.

Teleoperation of a Robot

Before starting, go to the Carmen sub-directory carmen/bin.

1. In window 1, start the IPC central server

  ./central

2. In window 2, start the parameter server

  ./param_deamon [paramfile.ini] --robot robotname

3. In window 3, start the base server that corresponds to your robot

  ./pioneer

4. In window 4, start the laser server

  ./laser

5. In window 5, start the robot server

  ./robot

6. In window 6, start the robotgui program

  ./robogui

Note that if you have a pioneer or scout robot, you can run the base_services program instead of steps 3, 4, and 5. It is not yet working with other robot types.

  ./base_services

Here is a bit more detail on the programs to be run.

  • central

Run this anywhere, but other programs need an environment vairable set before you run them: "setenv CENTRALHOST [hostname]" if that program is being run on a different computer than central. This program must be started first. If stop this program (with cntl-c, typically), all the other Carmen programs will quit.

  • param_deamon --robot robotname [paramfile.ini]

The robotname option directs the server to parameters specific to the robot which should exist in the file "carmen.ini". If you wish to use a parameter file other than carmen.ini, then that would be specified in the paramfile.ini option.

  • base_services

Run this program after central and param_deamon have been started. This program connects to the robot and to the various sensors on the robot, so it MUST run on the machine connected to that hardware.

Note: This program combines three modules. If the robot hardware is divided among multiple computers, then the modules can be used independently on different computers. this currently only works with the Scout robots from Nomadics Technologies and the Pioneer robots from ActivMedia.

  • scout - This module co-ordinates the motion of the Scout robot and monitors robot odometry.
  • pioneer - This module co-ordinates the motion of the Pioneer robot and monitors robot odometry. It is an alternative to scout.
  • laser - this monitors the SICK LMS and PLS laser sensors.
  • robot - this module takes odometry and sensor readings and combines them for distribution to other programs.
  • robotgui -add_control on

This opens a display which shows the robot as a circle or rectangle in the center with a small line designating the front and also sensor information. Blue regions are obstacles or unknown, white is clear. Red edges in the laser display indicate indicate obstacles which are close enough to prevent forward motion.

To turn the robot, use the left mouse button. Clicking near the robot will turn it right or left. To move the robot, click on the robot and drag the mouse pointer in the direction (relative to the "forward" indicator on the screen) you wish the robot to go. The robot indicator will turn red when you click on it, indicating that it is ready to move. The further from the robot you drag the cursor, the faster the robot will go.

Or, if you have properly installed your joystick under linux, you can drive the robot with the joystick.

Alternatively, you can use keyboard commands to move the robot. The following keys will move the robot:

  • U I O
  • J K L
  • M , .

with I moving the robot forward, U will move it forward and turning it left, O forward and right. J and L will turn the robot in place. Some robot param files are written so that the robot will not go backwards because some of our robots do not have rear sensing. M and . will move it backwards and turn, or just turn, depending on the parameter file. , will move it backwards or not at all. any other key, including K, will stop the robot. Speed cannot be controlled with this method.

Robotgraph.gif

In this image, the sensor data displayed is from a SICK PLS laser scanner. The robot is represented by the grey circle, facing the direction indicated by the black line. Dark blue edges are perceived objects, and lighter blue areas are unknown. The red edges are objects which are close enough that obstical avoidance routines will prevent forward motion.

Building a Map (using teleoperation)

To build a map, you can use either teleoperation or autonomous navigation. However, autonomous navigation requires that you start with a map, so this section describes how to do it with teleoperation. Another way to build a map is with the map editor program.

While the robot is moving, you will need to run the logger program.

Run steps 1 through 6 above for teleoperating the robot, then:

7. In window 7, start the loggger

  ./logger [filename].log

[filename] specifies a filename for the sensor log. If the file already exists, the program will ask to overwrite it. If an answer other than "Y" or "y" is given, then the logger will quit.

Drive the robot around, covering your environment, then stop the logger by typing a CONTROL-C in the logger xterm. Before quitting the other programs (or after restarting them at a later time), run vasco on the logfile you created

   ./vasco file.log

This program opens an interface which displays sensor data compiled with raw odometry data, as in this image:

Vasco1.gif

To correct for odometry error, click the "scan match" button on the upper right. After some computation time (progress is indicated on the lower left), the display will change, as in this second image:

Vasco2.gif

This data was generated moving a robot from a lab (center right) into a corridor, up and down the corridor some distance, then back to the lab. The odd "fuzz" in the center of the corridor is actually the legs of people walking by as the data was gathered.

To create the final map to be used with param_deamon, now click the "Make Evidence Grid" button on the upper right. A new display will open allowing you to adjust parameters for creating the mapfile. At first, you should stick with the defaults.

Vasco3.gif

When you click "Okay," that display will disappear, a new one will open and the map will form as you watch.

Egrid.gif

Note that the data which showed the people walking through the image has not effected the final map. To save this as a map, click on the "File" menu and save as a ".map" file.

This file can then be used through your param_deamon program to allow for localization and autonomous navigation through the area you mapped.

Autonomous Navigation

This begins as if you were teleoperating the robot, but with a change in the param_deamon options to add the map file, and with other programs added.

1. In window 1, start the IPC central server

  cd carmen/bin ; ./central

2. In window 2, start the parameter server

  cd carmen/bin ; ./param_deamon [paramfile.ini] --robot robotname mapfile.map

3. In window 3, start the base server that corresponds to your robot

  cd carmen/bin ; ./scout

4. In window 4, start the laser server

  cd carmen/bin ; ./laser

5. In window 5, start the robot server

  cd carmen/bin ; ./robot

6. In window 6, start the robotgui program

  cd carmen/bin ; ./robotgui

7. In window 7, Run the localizer

  cd carmen/bin ; ./localize

8. In window 8, Run the path planner

  cd carmen/bin ; ./navigator

9. In window 9, Run the path planner graphics module

  cd carmen/bin ; ./navigatorgui

Here is more detail on the new programs.

  • localize

This program takes sensor data from base_services and compares it to the map to localize the robot on that map.

  • navigator

This program plans the path from the robot's current location to its destination and tells base_services how to move the robot.

  • navigatorgui

This program provides a user interface for telling the robot where it is and where to go. To set the robot position on the map display, simply left-click the "Place Robot" button, then left-click the desired location on the map. The cursor will change into a pair of curved arrows, and a red dot appears ti indicate the robot location. A line between the dot and the cursor indicates the direction the robot's orientation. Left-click again to fix the robot orientation. If you are using a simulated robot, this will also place and orient the simulated robot. To separate the simulated robot from it's perceived location, you must set the simulator location after setting the robot location.

You can now control the robot using the navigator. You can then left click on the map to give the robot a goal. Select the "Go" button to send the robot from its current location to the selected goal. Select the "Stop" button (the same location as the "Go" button) to make the robot stop at any time.

Navpanel.gif

In this image, the robot's current perceived position is represented by the red circle, and the simulated position is represented by the blue circle. The robot's goal is represented by the yellow circle. The planned path is represented by the blue line. The planned path will change as the robot moves toward the goal and encounters obsticles. The scale of the image can be changed by moving the lower slide-bar.