Football Table Simulation Visualization Tool: Difference between revisions

From Control Systems Technology Group
Jump to navigation Jump to search
No edit summary
 
(55 intermediate revisions by 2 users not shown)
Line 1: Line 1:
<div STYLE="float: left; width:80%">
<b>Author: Erik Stoltenborg</b>
<b>Author: Rein Appeldoorn</b>
==Gazebo==
[[Image:gui.png|400px|thumb|right|Figure 1: Tool Overview]]
<p>A simulator is developed to easily test new algorithms without depending on the actual robot. In has been developed using [http://gazebosim.org/ gazebo] (w/o the use of ROS), a so-called ''physics abstraction layer'', which employs [http://www.ode.org/ ODE] combined with [http://www.ogre3d.org/ OGRE] for rendering. Gazebo has been very well maintained since 2012, since it became the official simulator for the [http://www.theroboticschallenge.org/ DARPA Robotics Challenge].
== Information ==
The environment/robots are described in the [http://gazebosim.org/sdf/dev.html SDF] format, which is very simular to *.xml. It can be easily combined with CAD-files, in this case is combined with a Collada <ref>*.dae, which can be created by e.g. exporting an NX CAD drawing to .stl which is then exported to *.dae using [http://www.sketchup.com/ sketchup] or [http://meshlab.sourceforge.net/ meshlab]</ref>
<p>A simulator is developed to easily test new algorithms without depending on the actual robot. Also, tests can be performed at a faster pase. This makes it easier to study problems such as higher level gameplay strategies. This simulation is created with use of [http://www.openrobots.org/wiki/morse MORSE], which is a Multiple Open Robot Simulation Engine.</p>


drawing for more complex geometry. A previous attempt was created using [http://www.openrobots.org/wiki/morse MORSE], however this was aborted because the poor tune-ability of the physics and limited options for communication.</p>
<p>A guide on how to build gazebo can be found [http://gazebosim.org/wiki/1.6/install#Compiling_From_Source here], the latest version that has been tested is 1.8.3 and can be found on the svn. Make sure to source the <code>setup.sh</code> located on the svn, instead of the one that comes with gazebo. </p>
[[File:Gazebo.png|thumb|center|upright=4.0|The gazebo simulator for the semi-automated soccertable.]]
==Synchronized Inter-process Communication==
<p>
<p>
Together with this simulator, a visualization tool (GUI) is developed to visualize the sensor data of the football table. This tool is connected with the simulator or the table and provides the interface to the user.  
To date, Gazebo is mostly used in combination with [http://wiki.ros.org/ ROS]. However using ROS plugins yields a lot of overhead, moreover the timers and communication provided there or not accurate enough to ensure an accurate casual link. Therefore a plug-in was created enabling fast light-weight inter-process communication, allowing to run simulation to be ran up to 20 times faster than real-time without loss of causality.
</p>
</p>


<p>
<p>
These different systems: Simulator, Football Table and the GUI are connected with use of the [http://eris.liralab.it/yarpdoc/what_is_yarp.html Yarp] Middleware.
This simulation communicates with Matlab Simulink using Interprocess Communication (IPC) wrapper library for the POSIX libraries, the wrapper makes the use of shared memory more accesible and easy to use. It uses shared memory protected by mutexes and condition variables enabling a thread-safe, synchronized, causal communication between two processes e.g. Gazebo and Simulink. This allows us to use the Gazebo simulator as a plant in our simulink control loop. Moreover this wrapper library could be used for (safe) IPC between two arbitrary processes. More on this library, it's basic principles and how it is used can be found [http://cstwiki.wtb.tue.nl/index.php?title=IPC here].
</p>
</p>
<references />


==== External Documentation ====
==Building the libraries/plugins==
<ul>
  <li>[http://cstwiki.wtb.tue.nl/images/Report_Rein_Appeldoorn_Visualization_Simulation_Tool_Football_Table.pdf Report: Development of a Simulation and Visualization Tool for an Autonomous Football Table - Rein Appeldoorn]</li>
  <li>[http://cstwiki.wtb.tue.nl/images/MORSE_installation_guide.pdf MORSE Installation Guide with Yarp support - Ubuntu 10.04 LTS x86]</li>
</ul>


== Structure ==
<p>After building gazebo and its requirements, you can build all libraries used for RL/IPC. These can be build by running the <code>src/shm_ipc/install.sh</code> and <code>/src/rl/install.sh</code>.</p>
[[File:Structure.PNG|left|thumb|400px|Figure 2: Structure]]
=== Data flow ===
<p>The current network-structure of the project is shown in Figure 2. In order to create a link between these subsystems, three connections are needed:</p>
<p>
  • Control &nbsp;&nbsp;&nbsp;&nbsp;&larr;&rarr;&nbsp;&nbsp; Simulator (Actuators/Sensors)<br />
  • Simulator &nbsp;&larr;&rarr;&nbsp;&nbsp; GUI (Visualization)<br />
  • Control  &nbsp;&nbsp;&nbsp;&nbsp;&larr;&rarr;&nbsp;&nbsp; GUI (Visualization)
</p>


=== Middleware ===
==Matlab Simulink==
<p>This data-communication is established with use of the [http://eris.liralab.it/yarpdoc/what_is_yarp.html Yarp] Server (which is integrated in the GUI). It creates the link between the multiple subsystems. Further information about this communication can be found in the [http://cstwiki.wtb.tue.nl/images/Report_Rein_Appeldoorn_Visualization_Simulation_Tool_Football_Table.pdf report].</p>


=== Tool ===
<p>The Simulink side of things can be found in <code>MOTION_test.mdl</code>, this is ''not'' an external, but is ran in simulink itself in the regular way. The main window is shown below, the simulator part is the the gazebo sub-system. The motion-generation contains the reinforcement learning, attractor dynamics and constraints for the actions. To start the simulation just press simulation->start. If you want to view what is going on, open a terminal and type <code>gzclient</code> to start the gazebo GUI.</p>
<p>The tool contains two elements: Visualization and Simulation. It communicates with the real football table or simulator to visualize the sensor data during a work-out. Starting simulations with use of this tool is not yet possible but can be implemented in the future. For now, the simulations has to be started with use of the [http://www.openrobots.org/wiki/morse MORSE] simulator and after that, a connection can be established to visualize the sensor-data of the simulator.</p>


== Graphical User Interface ==
[[File:MOTION_test.png|thumb|center|upright=1.5| Main window of <code>MOTION_test.mdl</code>]]
The GUI is created with use of two main elements: [http://qt.nokia.com/products/ QT] (UI Framework) and [http://www.ogre3d.org/ OGRE] (3D Graphics Engine). With use of the visualization, the user can see what information the robot obtains during a work-out. This part of the GUI visualizes the sensor data that comes from the real table or simulator. Updating this visualization and receiving data is done at a frequency of 50 hertz. This provides a smooth playback of the sensor data of the (simulated) robot to the user.


== Simulation ==
<p>In the motion generation sub-system the ETA (estimated time of arrival) is indicated (how long the simulation will take in minutes). Also the current episode number is displayed.</p>
[[File:model.png|left|thumb|400px|Figure 3: MORSE model]]
[[File:MOTION_test_RL.png|thumb|center|upright=1.5| Motion generation window <code>MOTION_test.mdl</code>]]
===Reinforcement learning settings===
====General====
<p>
<p>
The simulation is build with use of [http://www.openrobots.org/wiki/morse MORSE]. This robot simulator is based on [http://www.blender.org/ Blender]'s [http://www.blender.org/documentation/249PythonDoc/GE/GameLogic-module.html Gamelogic module] (Module for game-creation). This module is entirely scriptable with use of Python. These python-scripts can interact with the simulated environment.
Most relevant settings regarding the actions and the reinforcement learning are set in their respective masks. In the mask of <code>primitives_select.cpp</code> you can set all the parameters described in [http://cstwiki.wtb.tue.nl/index.php?title=Football_Table_RL#Library_functions this RL section].<br/>
</p>
In the tab named ''general'' the following settings are available:
<p>
[[File:RL_tab1.png|thumb|center|upright=1.0| General settings ]]
The [http://www.openrobots.org/wiki/morse MORSE] addition to this module makes it possible to communicate with these python scripts with use of middlewares or simple sockets. Local variables of these scripts can be modified or read; which results in a control of the simulated environment with use of an external client.
;Store Data
</p>
:Checkbox to enable the storage of data, this will store the buffers and the performance of the simulation you run.
<p>
;Store Policy
The [http://cstwiki.wtb.tue.nl/images/Report_Rein_Appeldoorn_Visualization_Simulation_Tool_Football_Table.pdf report] contains detailed information of the creation of this simulation-model and it's interactions with the external client. It also gives an overview of the [http://www.openrobots.org/wiki/morse MORSE] workflow which gives more insight in the working principle of the [http://www.openrobots.org/wiki/morse MORSE] simulator.
:Checkbox to enable storage of the policy. This will store the learned weight vectors <math>\theta,~w</math>, but also other settings such as the node positions (centers), number of states and actions etc.
;Data Path
:Path to the folder in which all data will be stored. A new folder with a timestamped name will be created, also the name of the folder indicates what RL algorithm was used.
;Number of states
:Number of states used as input to the learning agent
;Available states
:Vector with indices of the states, the allow quick changes you can select a couple of seperate states from the input of the simulink block. I.e. we only want the lateral position and speed of the ball. We can then say: Number of states = 2, available states [1 3] indicating index 1 and 3 in the learning state. Make sure to adjust the function approximation accordingly.
;Number of actions
:number of actions available to the learning agent
;Available actions
:Similar to available states, vector with indexes of the actions you want available (0-5).
;Number of samples
:Total of episodes that are done in this simulation until it is stopped. (Make sure the simulation runs long enough in order to finish all of them).
;Number of greedy samples
:Number of episodes in which fully greedy behavior is performed (<math>\epsilon=0</math>). If this is the same as the number of samples, then only greedy behavior will be performed.
</p>
</p>


</div><div style="width: 20%; float: left;"><center>{{:Football_Table_Menu}}</center></div>
====Learning parameters====
 
[[File:RL_tab2.png|thumb|center|upright=1.0| RL settings ]]
;Use GQ-learning
:Use greedy-GQ for updating the value function approximation
;Use approximate-Qlearning
:Use approximate-Qlearning for updating the value function approximation
;Use grid-based Q-learning
:Use grid based function approximation. This is no longer available in the latest version, you can still find in <code>primives_select_old.cpp</code>.
;Use hand-coded policy
:Use a user defined policy, this code is too be defined in primives_select.cpp. An actual handcoded policy can be found in <code>primives_select_old.cpp</code>.
;Alpha
:The learning rate <math>\alpha</math>
;Beta
:The secondary parameter for greedy-GQ <math>\beta</math>
;Gamma
:The discount factor <math>\gamma</math>
;Lambda
:Eligibility trace parameter  <math>\lambda</math>
;Use watkins traces
:Use Watkins style traces: cut-off a trace once an non-optimal(/exploratory) action is performed
;Trace depth
:Maximum amount of steps back the trace is updated
;Epsilon
:Exploration rate, the higher it is the more ''random'' actions are performed (not based on value).
 
====Value function approximation ====
 
[[File:RL_tab3.png|thumb|center|upright=1.0| RL settings ]]
<p>These settings are parallel to what is explained [http://cstwiki.wtb.tue.nl/index.php?title=Football_Table_RL#Library_functions here]. Make sure the size of these arrays matches the number of states defined in the ''general'' tab. The settings that are not explained [http://cstwiki.wtb.tue.nl/index.php?title=Football_Table_RL#Library_functions here] are:</p>
;Load policy?
:Checkbox indicating whether or not to load an old policy
;Policy Path
:Absolute path pointing to the folder in which the policy files can be found.

Latest revision as of 16:39, 16 May 2019

Author: Erik Stoltenborg

Gazebo

A simulator is developed to easily test new algorithms without depending on the actual robot. In has been developed using gazebo (w/o the use of ROS), a so-called physics abstraction layer, which employs ODE combined with OGRE for rendering. Gazebo has been very well maintained since 2012, since it became the official simulator for the DARPA Robotics Challenge. The environment/robots are described in the SDF format, which is very simular to *.xml. It can be easily combined with CAD-files, in this case is combined with a Collada [1] drawing for more complex geometry. A previous attempt was created using MORSE, however this was aborted because the poor tune-ability of the physics and limited options for communication.

A guide on how to build gazebo can be found here, the latest version that has been tested is 1.8.3 and can be found on the svn. Make sure to source the setup.sh located on the svn, instead of the one that comes with gazebo.

The gazebo simulator for the semi-automated soccertable.

Synchronized Inter-process Communication

To date, Gazebo is mostly used in combination with ROS. However using ROS plugins yields a lot of overhead, moreover the timers and communication provided there or not accurate enough to ensure an accurate casual link. Therefore a plug-in was created enabling fast light-weight inter-process communication, allowing to run simulation to be ran up to 20 times faster than real-time without loss of causality.

This simulation communicates with Matlab Simulink using Interprocess Communication (IPC) wrapper library for the POSIX libraries, the wrapper makes the use of shared memory more accesible and easy to use. It uses shared memory protected by mutexes and condition variables enabling a thread-safe, synchronized, causal communication between two processes e.g. Gazebo and Simulink. This allows us to use the Gazebo simulator as a plant in our simulink control loop. Moreover this wrapper library could be used for (safe) IPC between two arbitrary processes. More on this library, it's basic principles and how it is used can be found here.

  1. *.dae, which can be created by e.g. exporting an NX CAD drawing to .stl which is then exported to *.dae using sketchup or meshlab

Building the libraries/plugins

After building gazebo and its requirements, you can build all libraries used for RL/IPC. These can be build by running the src/shm_ipc/install.sh and /src/rl/install.sh.

Matlab Simulink

The Simulink side of things can be found in MOTION_test.mdl, this is not an external, but is ran in simulink itself in the regular way. The main window is shown below, the simulator part is the the gazebo sub-system. The motion-generation contains the reinforcement learning, attractor dynamics and constraints for the actions. To start the simulation just press simulation->start. If you want to view what is going on, open a terminal and type gzclient to start the gazebo GUI.

Main window of MOTION_test.mdl

In the motion generation sub-system the ETA (estimated time of arrival) is indicated (how long the simulation will take in minutes). Also the current episode number is displayed.

Motion generation window MOTION_test.mdl

Reinforcement learning settings

General

Most relevant settings regarding the actions and the reinforcement learning are set in their respective masks. In the mask of primitives_select.cpp you can set all the parameters described in this RL section.
In the tab named general the following settings are available:

General settings
Store Data
Checkbox to enable the storage of data, this will store the buffers and the performance of the simulation you run.
Store Policy
Checkbox to enable storage of the policy. This will store the learned weight vectors [math]\displaystyle{ \theta,~w }[/math], but also other settings such as the node positions (centers), number of states and actions etc.
Data Path
Path to the folder in which all data will be stored. A new folder with a timestamped name will be created, also the name of the folder indicates what RL algorithm was used.
Number of states
Number of states used as input to the learning agent
Available states
Vector with indices of the states, the allow quick changes you can select a couple of seperate states from the input of the simulink block. I.e. we only want the lateral position and speed of the ball. We can then say: Number of states = 2, available states [1 3] indicating index 1 and 3 in the learning state. Make sure to adjust the function approximation accordingly.
Number of actions
number of actions available to the learning agent
Available actions
Similar to available states, vector with indexes of the actions you want available (0-5).
Number of samples
Total of episodes that are done in this simulation until it is stopped. (Make sure the simulation runs long enough in order to finish all of them).
Number of greedy samples
Number of episodes in which fully greedy behavior is performed ([math]\displaystyle{ \epsilon=0 }[/math]). If this is the same as the number of samples, then only greedy behavior will be performed.

Learning parameters

RL settings
Use GQ-learning
Use greedy-GQ for updating the value function approximation
Use approximate-Qlearning
Use approximate-Qlearning for updating the value function approximation
Use grid-based Q-learning
Use grid based function approximation. This is no longer available in the latest version, you can still find in primives_select_old.cpp.
Use hand-coded policy
Use a user defined policy, this code is too be defined in primives_select.cpp. An actual handcoded policy can be found in primives_select_old.cpp.
Alpha
The learning rate [math]\displaystyle{ \alpha }[/math]
Beta
The secondary parameter for greedy-GQ [math]\displaystyle{ \beta }[/math]
Gamma
The discount factor [math]\displaystyle{ \gamma }[/math]
Lambda
Eligibility trace parameter [math]\displaystyle{ \lambda }[/math]
Use watkins traces
Use Watkins style traces: cut-off a trace once an non-optimal(/exploratory) action is performed
Trace depth
Maximum amount of steps back the trace is updated
Epsilon
Exploration rate, the higher it is the more random actions are performed (not based on value).

Value function approximation

RL settings

These settings are parallel to what is explained here. Make sure the size of these arrays matches the number of states defined in the general tab. The settings that are not explained here are:

Load policy?
Checkbox indicating whether or not to load an old policy
Policy Path
Absolute path pointing to the folder in which the policy files can be found.