gazebo_sfm_plugin

A plugin for simulation of human pedestrians in ROS Gazebo.

Check the branch galactic for the ROS2 version of this plugin

The persons are affected by the obstacles and other persons using the Social Force Model

The plugin has been tested under ROS Melodic and Noetic and Gazebo 9.x and Gazebo 11.

Acknowledgment

This work has been financed by the European Regional Development Fund (FEDER) and by the Ministry of Economy, Knowledge, Business and University, of the Government of Andalucía , within the framework of the FEDER Andalucía 2014-2020 operational program. Specific objective 1.2.3. "Promotion and generation of frontier knowledge and knowledge oriented to the challenges of society, development of emerging technologies" within the framework of the reference research project UPO-1264631. FEDER co-financing percentage 80%

Plugin configuration

The plugin can be applied to each Gazebo Actor indicated in the Gazebo world file.

An example snippet is shown next:

<actor name="actor1">
    <pose>-1 2 1.25 0 0 0</pose>
    <skin>
        <filename>walk.dae</filename>
        <scale>1.0</scale>
    </skin>
    <animation name="walking">
        <filename>walk.dae</filename>
        <scale>1.000000</scale>
        <interpolate_x>true</interpolate_x>
    </animation>
    <!-- plugin definition -->
    <plugin name="actor1_plugin" filename="libPedestrianSFMPlugin.so">
        <velocity>0.9</velocity>
        <radius>0.4</radius>
        <animation_factor>5.1</animation_factor>
        <people_distance>6.0</people_distance>
        <!-- weights -->
        <goal_weight>2.0</goal_weight>
        <obstacle_weight>80.0</obstacle_weight>
        <social_weight>15</social_weight>
        <group_gaze_weight>3.0</group_gaze_weight>
        <group_coh_weight>2.0</group_coh_weight>
        <group_rep_weight>1.0</group_rep_weight>
        <ignore_obstacles>
            <model>cafe</model>
            <model>ground_plane</model>
        </ignore_obstacles>
        <trajectory>
            <cyclic>true</cyclic>
            <waypoint>-1 2 1.25</waypoint>
            <waypoint>-1 -8 1.25</waypoint>
        </trajectory>
    </plugin>
</actor>

The parameters that can be configured for each pedestrian are:

General params

<velocity>. Maximum velocity (m/s) of the pedestrian.
<radius>. Approximate radius of the pedestrian's body (m).
<animation_factor>. Factor employed to coordinate the animation with the walking velocity.
<people_distance>. Maximum detection distance of the surrounding pedestrians.

SFM Weights

The weight factors that modify the navigation behavior. See the Social Force Model for further information.

Obstacle params

<ignore_obstacles>. All the models that must be ignored as obstacles, must be indicated here. The other actors in the world are included automatically.

Trajectory params

<trajectory>. The list of waypoints that the actor must reach must be indicated here.
- <waypoint>. Each waypoint must be indicated by its coordinates X, Y, Z in the world frame.
- <cyclic>. If true, the actor will start the waypoint sequence when the last waypoint is reached.

Dependencies

Social Force Model library, lightsfm https://github.com/robotics-upo/lightsfm

Compilation

This is a ROS package so it must be placed inside a ROS workspace and compiled through the regular Catkin tools.

Example

An example Gazebo world can be launched through:

roslaunch gazebo_sfm_plugin cafe.launch

robotics-upo / gazebo_sfm_plugin

readme